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ABSTRACT 

This users' guide documents a collection of computer programs 
and subroutines written in FORTRAN to calculate 4-body (sun-earth- 
moon space) and 3-body (earth-moon space) optimal trajectories. 

The programs incorporate a new variable step integration technique 
and a new quadrature formula to correct single step errors. These 
new features have resulted in significant improvement in efficiency 
and accuracy. 

The programs provide capability to solve initial value problem, 
two point boundary value problem of a transfer from a given initial 
position to a given final position in fixed time, optimal 2-lmpulse 
transfer from an earth parking orbit of given inclination to a given 
final position and velocity in fixed time and optimal 3-impulse 
transfer from a given position to a given fihal position and velocity 
in fixed time. 



. INTRODUCTION . 

This users’ guide documents a collection of computer programs and sub- 
routines written in FORTRAN to calculate 4-body optimal trajectories under the 
combined influence of the sun, earth, and moon. Additional programs and sub- 
routines have been provided so that 3 -body optimal trajectories can be computed 
without the influence of the sun. ■ 

The method used in the extrapolation of the state vector and the solution of 
boundary value problems is essentially the same as presented in Ref. (1) and (2). 
However, the present programs incorporate a new variable step integration tech- 
nique and a new quadrature formula to correct single step errors. These changes 
have resulted in significant improvement in efficiency and accuracy. The 4-body 
as well as the 3 -body state extrapolation subroutine automatically determines the 
step size that will yield a fixed estimate of the single step position and velocity 
errors. The quadrature formula developed by T. N. Fdelbaum is based on the 
4th derivatives of the position error estimates at the beginning of a step and the 
second derivatives of the Stumpff-Weiss position errors at the end of the step. ( 

In addition, two subroutines have been provided to compute target position 
and velocity in a Halo orbit about the L x libration point on the sun-earth line or 
one of the libration points on the earth-moon line. State vectors are now available 
also in rotating frames similar to the familiar barycentric frame commonly used 
in the restricted 3-body problem. These new features will be described in some 

detail. 
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PROGRAM ORGANIZATION 


The 4-body and 3 -body programs consist of 4 options. The name of a 3-body 
program is given in parenthesis following the name of a corresponding 4-body 
program. 


Option 1: 


Option 2: 


Option 8: 


Option 4: 


Program TRAJ (TPAJ3) 

This option is a trajectory integration program to solve initial value 
problems. 

Program EXLAM (EXLAM3) . 

This option is a program to solve two point boundary value problem 
of a transfer from a given initial position to a given final position in 

fixed time using Newton- Raph son method. 

Program ETP2I (ETP2I3) 

This option determines the optimal 2 -impulse transfer from an earth 
parking orbit of given inclination to a given final position and velocity 
in fixed time. It employs an accelerated gradient projection method 
using Davidon's Variance algorithm. , 

Program PTP3I (PTP3I3) i 

This option computes the optimal 3-impulse transfer from a given 
initial position to a given final position and velocity in fixed time. 

It uses an accelerated gradient method (Davidon's Variance 
algorithm) in the outer-loop and Newton- Raphson method in the second 


leg of. the inner loop. 


These 4 main programs call one or more of the following subroutines. 


Sub routine 

FOUR BY (TllRBl)Y ) 
TWOBDY 
CSTEP (CST.EP3) 

DELRV (DELRV3) 
LAMB (LAMB3) 
CTAR (CTAR3) 

COMIC (COMIC3) 

COM KG (OOMKGH ) 


Function 

State extrapolation. 

2 -body state extrapolation. 

Computes single step size and error estimate at beginning 
of step. 

Computes corrections by quadrature formula. 

Solves Lambert problem. . 

Computes target position and velocity on a Halo orbit about 
a libration point. Called by ETP21 (ETP2I3). 

Transforms input parameters with respect to earth into 
states with respect to sun (4-body) or earth (3-body). 
Computes function and gradient In FTP2M ETP2I3). 
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COMAtJG 

COMDX 

COMF (COMFS) 

COMG 

PVEC 

RVEMV 

UPX 

DISP (DISP3) 
PTRAJ (PTRAJ3) 
FDATA (FDATA3) 


Forms augmented function and gradient in ETP2I (ETP2I3) 
Computes changes in independent variables in ETP2I 
(ETP2I3). 

Computes function in PTP3I (PTP3I3). • 

Computes gradient in PTP3I (PTP3I3). 

Advances primer vectors and. monitor its magnitude in 
FOURBY (THRBDY), 

Computes state vectors in FOURBY. Not used in 3-body. 
Updates variables and functions in ETP2I (ETP2I3). 
Computes states in rotating coordinates for display. 

Prints trajectory. 

Files data for further processing outside of the program. 


The main programs and the above mentioned subroutines will be described 
in some detail in the sections to follow. In addition, there are a number of service 
subroutines, which performs standard mathematical operations. 


Service Subroutines 

MXV 

VVT 

DOT 

VMAG 

INVERT 

UNITV 

vxv 

M TRANS 
M.XM 


Function 

Multiplication of a vector by a matrix, a-Mb, 

— _T 

Outer product of a vector, M * aa . 

Dot product of 2 vectors, ” 5 a T b. 

Magnitude of a vector. . 

Inversion of a matrix 

Unit vector of a vector 

Cross product of 2 vectors, a = bxc. 

T 

Transpose a matrix, N ° M . 

Multiplication of 2 matrices, C = MN 


These service subroutines will.be listed but not discussed further. 


A tabulation of the subroutines called by the main programs is given in 


Table 1. 



Table 1 PROGRAMS AND SUBROUTINES 


*^--^Program 

Sub- 

routine 

TRAJ 

(TRAJ3) 

exlAm 

(EXLAM3) 

I 

ETP2I 

(ETP2I3) 

PTP3I 

(PTP3I3) 

FOUR BY ( THRBDY ) 

X 

x 

X 

x • 

TWOBDY 

X 

X 

X 

X 

CSTEP (CSTEP3) 

X 

x 

x 

X 

DELRV (DELRV3) 

x 

X 

X 

X 

COMIC (COMIC3) 

X 

X 

x 


COMFG (COMFG3) 



X 


COMF (COMF3) 




X 

COMG 




x 

LAMB (LAMB3) 


X 


X 

COMAUG 



X 


COMDX 



X 


CTAR (CTAR3) 



X' 

. 

UPX 



X 

, • 1 

RVEMV 

X 

X 

X 

X 

PVEC 

X 

x 

X ; •; 

X 

DISP (DISP3) . 

X 

X 

X 

X 

PTRAJ (PTRAJ3) 

X 

X 

X 

X 

FDATA (FDATA3) 

X 

x 

X 

X, 

MXV . 

X 

X 

X . 

x 

VVT 

' X 

x 

X 

X 

DOT 

X 

x 

x . 

X 

VMAG 

X 

X 

X. 

X 

INVERT 


X 

X 

X 

UNITV . 

X 

X 

x - 

X 

VXV 

X 

X 

X 

X 

M TRANS 



X 

X 

MXM 

X 

X 

X 

X 


Note: 1 Not used in 3 -body programs. 




COORDINATES SYSTEMS 

The position or velocity vector of a body with respect to another body may 
be expressed in different coordinates systems at different stages of computation. 

These coordinates systems are described below. 

Coordinate Systems 
S -fra me 

(Basic computation frame 
in 4-body, programs) 

Definition 

An inertial frame centered at the sun in which state 
extrapolation is performed. Since it is likely that 
input epheme rides will be obtained from JPL tapes, 

. the X s -Y s plane will be the Ecliptic -Equinox plane of 
1950, 0, with the X> axis pointing in the Equinox 
direction. 

E-frame 
(4 -body) 

An Inertial frame centered at the earth parallel to 
S-frame. 

M -frame 
(4-body) 

An inertial frame centered at the moon parallel to 
S-frame. 

e-frame 

(Basic computation frame 
in 3 -body programs) 

An inertial frame centered at the earth. The X g -Y e 
plane is the Equator -Equinox plane of 1950. 0 with 
X pointing in the Equinox direction. 

m-frame 

(3-body) 

An inertial frame centered at the moon parallel to 
e-frame. 

L-frame 

(4-body) 

A rotating frame centered at the Lj lib ration point 
used to define a target on a Halo orbit about L^. 
The Xj-axis is along the line from the sun to the 
ea rth- moon bary center. The Z^-axis Is along the 
total angular momentum vector of the earth and 
moon about the sun. 

A-frame 

(3-body) 

A rotating frame centered at either Lj or Lg 
Iteration point to define a target on a Halo orbit. 

The X^-axis is along the line from the earth to the 
moon. The Z^-axis Is along the angular momentum 
Vector of the moon about the earth. 

. 5 . ' ; ' • ' ' 



O- frame An inertial frame centered at the earth. The X„-Y 0 

plane is the parking orbit plane of an Inclination i. 

The XQ-axis is along the line of ascending node. 

D-frame A rotating frame centered at the earth used for 

(4-body) display purpose. This frame is the equivalent of the 

rotating bary centric frame in a restricted 3 -body 

problem. The X D ~axis is along the line from the sun 
to the earth. The Z D > axis is along the angular 
momentum vector of the earth about the sun. 


d-frame A rotating frame centered at the moon used for 

(3-body) display purpose. The X^-axis is along the line from 

the earth to the moon. The Z d -axls is along the 
angular momentum vector of the moon about the 
earth. 

These frames are shown In Figure 1. 

In general, when there is no ambiguity, a vector of a body A with respect to 
another body B will be written with subscripts BA. For example, R gv will be a 
position vector of the vehicle with respect to the sun in the S-frame. Sometimes, 
it is necessary to add a superscript to indicate the frame in which the components 
are resolved. Thus, w gL S Is the angular velocity of the L-frame with respect to 
the S-frame with components in the S-frame. 


A transformation matrix will be denoted by a subscript and a superscript. 

it will transform a vector from the frame indicated by the subscript to the frame 
.... nL _ L TjS . „ 75 


Indicated by the superscript. For example IT 
to B In L-frame. 


C g L transforms II in S-frame 






To Equinox 



X-Y Plane parallel to 
Ecliptic-Equinox plane 
of 1950.0. 



Figure la Inertial S, E, and M Frames 



X e -Y g : Equator- Equinox 
plane of 1950.0. 


Figure lb Inertial e and O Frames 




* e 

m-Frame is centered at 



moon parallel to e-Frame. 


Figure le 

m and d Frames j 



z. 

' .swr-rXHXr.r'- 




VARIABLE STEP INTEGRATION 

The variable step integratipn technique used in subroutine FOUR BY (THRBDY) 
is summarized here. The computation of step size and estimates of position errors, 
which is performed in subroutine CSTEP (CSTEPS), is an extension of D'Amario's 
derivation for the 3-body problem (Ref. 4). Let 

R ^t+h) = approximate vehicle position determined by Stumpff-Weiss method 
R (t+h) D true vehicle position 


The position error at the end of a single step is 

7(t+h) = R(t+h) - THt+h) 

Expanding Eq. (1) in Taylor series at t we obtain 

c(t+h) « 7(t) + 7(t)h + c^t) h^ + ^ T(t) h'^ + tj-j c(t) h + 0(h ) 


( 1 ) 


( 2 ) 


By definition. 


7(t) * 0 


(3) 


It can be shown that 


C(t) = "eft) * €(t) = 0 


(4) 


The first non-zero term is the 4th derivative term. Neglecting all higher 
derivative terms the position error is given by 

. h 4 ' 

c(t+h) 


(5) 


Let 


l?(t+h)| 


‘max 


allowable single step position error 


( 6 ) 


Then, an estimate of step size is given by 


h = [24 

V Y(t) 1 


1/4 


(7) 


TO 



In CSTEP we compute c' R ’ sv to estimate step size h and also < RS e and € rsm for 
for use in DELRV to compute error corrections. If we make the following 
definitions In a 4-body space. 



we can express the estimated errors by 



7 RSV (t ' 4 ’ > *• 1 G SV S *SV + G EV 8? EV + — — - G SE flg SE 

**S TE 

+ ~~~~~~ G SM 


+ g mv 6 %v + 


M S + M M 


•RSE 




<t+h) = (g se 6gg E “ w EM V6 EM 

Me 

+ g sm 6 §sm} h + 0<hE 

+ 


? RSM (t+h) = (%M S " g SM T 7“ T— “EM“ 8 EM 

Me Mm 


+ — G™ «g. 


( 10 ) 


M E 


m s + Me 


C SE 6 8“se} W + 0(h5) 


In CSTEP3 we compute < REV to determine h and the error may be expressed by 


REV 


(t+h) - {c, EV «g EV + a MV «g MV } + 0(h 5 ) m) 


Note that e HETyT “ 0 in a 3-body space. 
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CORRECTION OF ERRORS BY QUADRATURE FORMULAS 

The quadrature formulas proposed by T. N, Edelbaum and used in subroutine 
DELRV (DELRV3) to compute a single step position and velocity corrections are 
presented here. 


Assume the second derivative of the position error in a single step is given by 


.z 

7 = \ (a+'Et) 

(12) 

where 


aT = ^0) 

(13) 

Then the second derivative of the position error at the end of a singl step is given by 

K 2 - ■ 

Tj E -»r (a +"Eh) 

(14) 

! 

Solving Eq. (14) and using Eq. (13), 

‘ j ' 

2T.T n 


TT _ • 1 „ ■ 0 

b ‘ p K 

(15) 

Integrating Eq. (12) 


H- 

ir 

■fe 

. (16) 

- . at 4 . Bt 5 

e -,tt ir 

(17) 

Using Eqs.(13) and (15) in (16) and (17), we obtain the following corrections at the 

end of a single step. 


*1 = l(*0 V +7 l) 

(16) 

T 1 c 70* fe) V + T l) 

(19) 


•jjj is the 4th derivative of position error estimate at the beginning of a step and 
Is the second derivative of Stumpff-Weiss error estimate at the end of the step. 



INPUT PARAMETERS 

The following input parameters are required for all 4 options. 


Parameters 

Symb ol or De flnltlon 

Suggested Value 

4- Body Programs: 



CtL.l 

y Ll 

1.001098 x 10“ 2 

AUM 

1 unit of distance in 
meters 

1. 49507893 x 10 11 m 

UTIME 

1 unit of time in days 

58,1323577631 days 

UVELM 

1 m/ s in dimensionless 
velocity 

3. 35742409867 x 10 -5 

MS 

(sun) 

9. 99996959568 x 10 -1 

ME 

(earth) 

3. 00348453188 x 10 -6 

MM 

gjyj (moon) 

3.69431224671 x 10 -8 

RSKO. 



VS130 

. V SE {t o ) .. . 


iiSMO 

T? SM <t o ) 


VSMO 

V SM ( V 


3 -Body Programs 

(Ref. 4 and 5) 


GAMMA 

y 

y Ll to 0. 150935 
y l 2 ■ -0.167833 

UDM 

1 unit of distance in 
meters 

3. 8441 xl0 8 m 

UTIME 

1 unit of time 

104.362/24 days 

UVELM 

1 m/.s in dimensionless 
velocity 

1/1023.17 m/s 
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ME 

M e (earth) 

. 0878493 

MM 

(moon) 

. 0121507 

REMO 



VEMO 

V EM (t o’ 



Common to both 4- and 3-Body Programs; 


IPV 

Flag to compute primer 
vector 

IPV e 0, no 
1. yes 

IPTRAJ (IPTJX) 

Flag to print trajectory 
each time step 

IPTRAJ (IPTJX) = 0, no 
1, yes 

IFILEX (IFILE) 

Flag to file data each 
time step 

IFILEX (IFILE) ■ 0, no 
... 1. yes 

ERRMXM 

Allowable single step 
position error In 
meters 

150 m or higher 

ERRMAX 

Dimensionless 

ERRMXM 

10 or higher 

TDAYO 

Starting time in days 
from reference date 



TRIF.D 


Trip time in days 


The following input parameters are required for Davidon's variance 
algorithm used In ETP2I (ETF2I3) and PTP3I (PTP3I3), See Ref.. 2, Appendix A. 


10 -11 for ETP2I (ETP2I3) 
10" 3 for PTP3I (PTP3I3) 



V V. 

ICOMV 

EP.SV 


Davidon’a Variance matrix. 

It ICOMV * I, this Input Is not 
needed and the program will 
compute an estimate. Once a 
working V matrix has been 
developed through iterations, it 
should be used in a hew run to 
continue iteration. 

Flag to compute V. 

ICOMV - 0, no (input V) 
l, yes 

Small number to scale down 
V matrix if ICOMV * 1. It specifies 
the magnitude of the first step in the 
gradient direction, A typical value 
is about 10 ^ . , 




PROGRAM 

TRAJ. (TRAJ3) 

A. Input Parameters 


Parameters 

Symbol 

Definition/ Value 
Mode to select input 

IMODE 

IMODE <= 1 

IMODE = 1, 2, or 3 

HE V MAG 

|H EV (t 0 )| 

4. 38 739157152 x lO -5 for 100 n. m. 
parking orbit. 

VEVMAG 

<1 

1*1 

< 

Estimate of departure velocity 

magnitude with respect to earth. 

OINCD 

l (deg) 

Indlination of earth parking orbit. 

OBLD 

OBL (deg) 

Obliquity angle ~ 23.44578 74301825 9 

(not used in 3 -body) 


deg between E-frame and e-frame. 
Position of vehicle from ascending 

THED 

0 (deg) 

node in orbital plane. 

LOND 

0 (deg) 

Longitude: of ascending node. 

' ■ ■ • . ; 

IMODE ® 2 


REVO 

*EV<V 


VEVOP 

Vv 

IMODE = 3 


RSVO 

H sv (°) 


VSVI 

V<°> 



B. Computation 

Inputs of IMODE = I or 2 are converted into position and velocity of vehicle 
In S-frame or e-frame. The initial states are propagated to the final time using 
subroutine FOURBY (THRBDY). 

C. O utput Parameters 

Terminal states are printed out. States at each time step will be printed 
out if IPTRAJ = 1 and they will be filed if I FILE =1. 
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Definition/ Value 


PROGRAM EXLAM (EXLAM3) 

A. Input Parameters 
Parameters Symbol/ Unit 

Mode to select input 

IMODE IMODE = 1 or 2 

Same inputs for IMODE * 1, 2 as shown under PROGRAM TRAJ (TRAJ3) 


ERRMIN 

KNR 

ITLMAX 

RSVTAR 

IPTJX 


“MIN 


W 


IFILEX 


B. 


Allowable error for stopping Newton - 
Raphson method (10 

Initial estimate of change in Initial 
velocity magnitude (1) 

Maximum number of iterations (50) 

Target position 

Flag to compute and print trajectory 
after convergence , 

IPTJX « 0, no 
1, yes 

Flag to compute and file trajectory 
after convergence 
IFILEX = 0, no 
1, yes 


Computation 

Program calls subroutine LAMB (LAMB3) to solve the boundary value 
problem. 


C. Outpu t Parameters 

Outputs are given under subroutine LAMB (LAMBS). . If either IPTJX =1 or 
IFILEX « 1, the trajectory after convergence will be printed or filed or both.: 




PROGRAM ETP2I (ETP2I3) 


A, Input Parameters 


Parameter 

ITAR 

Symbol 

Definition 

Flag to input or compute target 
ITAR - 0, compute 
1, Input 

REVMAG 

I^EV^o>l 


OINCD 

i (deg) 


OBLI) 

OBL (deg) 


tdayo 

t Q (deg) 


TTRIPD 


t f -t o (day) 

VEVMAG 


.j 

LOND 

0 (deg) 


THED 

9 (deg) 

. . > " 

KDX 


Initial value of constraint restoration 
parameter (start with KDX * 1) 

•EPSV 

EPSTSI 


V-matrix scaling 

Allowable constraint violation (10 10 ) 

ITERMX 


Max. No. of iterations 

' ITAR « 0: 
AYM • '■ 
AZM 
ATARD : 

A y < m) ' 
A z (m) 

a tar (deg) 

Parameter to define target on 
Halo orbit. 

A » 2 x 10 5 km 
A ' B 1 x 10 5 km 

A_ at? B Target position measured 

I Ail . 

n from X L or X^ axis. 

4- Body: 
RSEO 

^SE ( V 


VSEO ' 

. . V SE (t o } 


RSMO 



•VSMO 

^SM^V 
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ITAR “ l: 

RSVTAR ^SVTAR^P 

VSVTAR V SVTAR ( V 

3-Body: 

REMO ^EM^oV 

VEMO T EM (t o ) 

ITAR * h 

REVTAR ^evtar^ 

vevtar t evtar ( V 


B. Computation 

See Ref; 2 appendix, program listing and flow chart. 


c. Internal Parameters 

ALPHA, BETA 


Davidon algorithm parameters 

ALPHAM, 

BE TAM 


Davidon algorithm parameters 

Current 

Trial 

Dummy 


Variables 

Variables 

Variables 


X 

XS 

XD 

Independent variables 

F 

FS 

FD 

Cost 

G 

GS 

GD 

Cost gradient 

FG 

FGS 

FGD 

Augmented cost 

. TSI 

TSIS 

TSID 

Constraint violation 

LT 

LTS 

LTD 

Constraint gradient 

GG 

GGS 

GGD 

Augmented cost gradient 

TESTR 

TESTRS 

TESTRD 

Magnitude of constraint violation 

KDX 



Constraint restoration scaling 
(internally adjusted) 


20 i. 



V matrix internal scaling 
(internally determined) 

Parameters to compute quantities 
to update V matrix 

Estimate of twice the excess of cost 

above its minimum value. If 

P < EPS, the problem is considered 
to be converged. 



Program ETP2I and ETP2I3 


Nominal 

Trajectory 


Constraint 

.Satisfied-?. 


Iteration 

Loop 


Trial 

Trajectory 


Constraint 

.Satisfied? 


Cost 

Reduced ? 


Update 


X = Independent 
Variables 


Update 
V Matrix 








PROGRAM PTP3I (FTP3I3) 


A. Input 

Parameters 


Parameters 

Symbol 

Definition 

4- Body: 



RSVO 

R SV (t o ) 


VSVO 

V S V ’<V 

Velocity before initial impulse 

VSVI 

Vv 

Velocity after initial impulse 

RSEO 



VSEO 

V SE <t o ) 


FSMO 

*SM ( V 


VSMO 

V SM (t o ) 


VSVMP 

V SM +<t m ) 

Velocity after interior impulse 

TM 

v 

Time of interior impulse 

RSVTAR 

r svtar ( V 

Target position 

VSVTAR 

V SVTAR (t f > 

Target velocity 

3- Body: 



REVO 

*iv<V. 


VEVO 

^EV (t o ) 

Velocity before impulse 

VEVOP 

*EvV 

Velocity after impulse 

REMO 

^EM ( V 


VEMO 

. V EM (t O ) 


. VEVMP 

V EV (t m J 

Velocity afte r inte rior impulse 

TM 

t m 

Time of interior Impulse 



Common to 4 -Body and 3 -Body: 

ITLMAX 

ILINC 

IT DM AX 

FMINM 

KNR 

E RUM IN 

B. Computation 

See Ref, program listing and flow 

C. Internal Parameters 

SG 

ALPHA 
SGS 

R, RC 

ALPHA C 
P, PC 


Maximum number of Lambert 
iterations 

Number of increments to solve 
Lambert problem 

Maximum number of Davidon 
ite rations 

Estimated mlnimun value of AV (m/s) 

Lambert iteration parameter 
(use KNR 3 1 to start) 

Allowable constraint violation GO 10 ) 


chart. 1 

Projection of cost gradient on 
search direction. , . 

Step size in search direction 

Projection of trial point cost 
gradient on search direction, its 
sign is used to determine whether 
as interpolation or a reduction of 
interval is to be made. 

Parameters to update V matrix. 

R used in trial step. RC used in 
interpolation. 

Step size in search direction 
determined by cubic interpolation. 

Parameters to update V matrix. 

P used in trial step, PC used in 
interpolation 



EPS 

If magnitude of cost gradient is less 

then EPS, the problem is considered 

to be converged. 

F 

Cost 

GMAG 

Magnitude of cost gradient. 

GSMAG 

Magnitude of cost gradient of a 
trial point. 

GCMAG 

Magnitude of cost gradient of an 
interpolated point. 

RMAG 

Magnitude of R. 

RCMAG 

Magnitude of RC. 

FS 

Cost of a trial point. 

FC 

Cost of an interpolated point. 

DG 

Difference in cost gradient. 

DX 

Change in independent variable to 
compute a trial point. 

DXC 

Change in Independent variable to 
compute an interpolated point. 

PVMMAG, PVPMAG 

See subroutine COMG 


D. Stopping Options 

The programmed stopping condition is when GMAG is reduced to less than 
EPS, However, one should stop the iteration if F is not decreasing significantly 
from one iteration to the next. On the other hand, it may be necessary to continue 
iteration to satisfy the Condition that PVMMAG is nearly equal to PVPMAG. 

(See comment in Ex, 4, ) 



Program PTP3I and PTP313 


Nominal 

Trajectory 


Ite ration 
Loop 


Trial 

Trajectory 


Update 
V Matrix 


Interpolation 


X . * Independent Variables 
* * 

V o + “ V SV +<t o ) 0I * V EV ( V 


'r 

No 

; .Cubic" ; ''' , 


Interpolation 

i 111 • 


Goet 

Reduced 

\ v 


Trial 

Trajectory 


Reduce 

Interval 


Update 
V Matrix 


Restart 

\ ? V 


Reset 
V Matrix 


^Cost ^ 
Reduced 

NSs Tn^ 


Reduce 

Interval 
















INPUT DATA DECKS 


Program 
Card No. 
i . 

TRAJ : 

Format 
4 D20.ll 

Parameters 

GL1, AUM, UTIME, UVELM 


2 

3 D20.ll 

MS, ME, MM. 


’ 3 . 

. ' 415 

IMODE, IPV, IFTRAJ, IFILE 


4 

4 D20.ll 

RSEO(l), RSE0(2), RSE0(3), VSEOfl) 


J 5 

4P20.11 

VSE0(2>, VSE0(3), RSM01), RSM0(2) 


6 

4D20. 11 

RSM0{3), VSMO(l), VSM0(2), VSM0{3) 


7 

3 D20.ll 

TDAYO, TRIPD, ERRMXM 


The above 7 input cards 
depend on the mode selected 

are needed for all modes. The following 2 cards 

1 




IMODE = 1 


8 

4 D20.il 

FEVMAG, VEVMAG, OINCD, OBLD 


9 

2 D20.ll 

LQND, THED 




[MODE * 2 


8 

4D20.11 

REVO(l), REV0(2), REV0(3), VEVOP(l) 


9 

2 D20.ll 

VEV0P(2), VEV0P(3) 




IMODE = 3 


8 

. 4 D20.ll 

RSV0I1), RSV0(2), RSV0(3), VSV1(1) 


, 9 

2 D20.ll 

VSVI(2), VSVI{3) 


10 

Hu* following 2 Input cards are needed if IPV-" 1 

4D20.11 PV0<1), PV0(2), J?V0Cn, PV{)<4> 


11 

2D20.11 

PV0 (5), PVO (6) 
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Program TRAJ3 


Card No. Format 

Parameters 

1 

4020.11 

GAMMA, UDM, UTIME, UVELM 

2 

2020.11 

ME, MM 

3 

4 02 0.11 

IMODE, iPV, IPTRAJ, IFILE 

4 

4D20.11 

REMO(l), REM0(2), FEM0(3), .VEMO(l) 

5 

2020.11 

VEM0(2), VEM0(3) 

6 

3D20.11 

tdayo, tripd, errmxm 


The above 6 input cards 

are needed for all modes. The following 2 cards 

depend on the mode selected. 




IMODE = 1 

7 

4D20.11 

REVMAG. VEVMAG, OlNCD, LOND 

B 

1 D20.ll 

THED . 



IMODE = 2 

7 

4D20, 11 

REV0(1), REV0(2), REV0<3), VEVOP(l) 

8 

2D20.11 

VEV0P<2), VEV0P(3) 


The following 2 cards are needed if IPV =1 

9 

4020.11 

PVOU), PV0(2), PV0(3), PV0(4) 

10 

2 D20.ll 

PVO (5), PV0<6) 
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Program EXLAM 


Card No, Format 

Parameters 

1 

4D20.ll 

GL1, AUM, UTIME, UVELM 

2 

3D20.11 

MS, ME, MM 

3 

415 

IMODE, ITLMAX, IPTJX, IF1LEX 

4 

4 D20.ll 

RSEO(l), RSE0(2), RSE0{3), VSE0(1) 

5 

4D20.11 

VSE0<2), VSEOO), RSM0<1), RSM0(2) 

6 

4 D20.il 

RSM0(3), VSMO(l), VSM0(2), VSM0(3) 

7 

3 D20.ll 

TDAYO, TRIPD, ERRMXM 

8 

4D20. 11 

RSVTARU), RSVTAR<2), RSVTAB(3), ERRMIN 

9 

1D20.11 

KNR 


The above 9 cards are needed for all modes. The following cards depend 

on the mode selected. 




IMODE = 1 

10 

4D20.11 

REVMAG, VEVMAG, OINCD, OBLD 

11 

2D20.11 

LOND, THED 



IMODE - 2 

10 

4D20.11 

REV0(1), REV0(2), REV0{3>, VEVOP(l) 

11 

2D20.11 

VEV0P(2), VEV0P(3) 



IMODE = 3 

10 

4D20.11 

RSVO(l), RSV0<2>, RSV0<3), VSVI(l) 

11 

2D20.11 

VSVI(2), VSVI{3) 



Program EXLAM3 
Card No. Format 

1 4D20.ll 

Parameters 

GAMMA, UDM, UTIME, UVELM 

2 

2 D20.ll 

ME, MM 

3 

415 

IMODE, ITLMAX, IPTJX, IFILEX 

4 

4D20.11 

REM0U), REM0<2), REM0(3), VEMO(l) 

5 

2 D20.ll 

VEM0(2), VEM0(3) 

6 

3D20.11 

TDAY0, TRIPD, ERRMXM 

7 

4D20ai 

REVTAR(l). REVTAR{2), HEVTAR(3), ERRMIN 

8 

1D20.11 

KNR 

The above 8 cardB are needed for all modes. The following cards depend 
on the mode selected. 



IMODE * 1 

9 

4D20.ll 

REVMAG, VEVMAG, OINCD, LOND 

10 

1D20.11 

THED 



IMODE = 2 

9 

4D20.11 

REV0(1), REV0<2>, REV0<3), VEVOP(l) 

10 

2 D20.ll 

VEV0P(2), VEV0P(3) 



Program ETP2I 


Card No. Format 

Parameters 

1 

4D20.11 

GL1, AUM, UTIME, UVELM 

2 

3 D20.ll 

MS, ME, MM 

3 

4D2p.ll 

REVMAG, OINCD, OBLD, ERRMXM 

4 

2 D20.ll 

TDAY0, TTRIPD 

5 

3 D20.ll 

VEVMAG, LOND, THED 

6 

4D20.11 

RSEO(l), RSE0(2), RSE0(3), VSEOfl) 

7 

4D20.11 

VSE0(2), VSE0(3), RSM0(1>, RSM0(2) 

e 

4 D20.ll 

RSM0(3), VSM0(1), VSM0(2>, VSM0(3) 

9 

4D20.11 

EPS, EPSTSI, KDX, EPSV 

10 

415 

‘1 

ICOMV, ITERMX, IFILEX, ITAR 


The next 1 or 2 cards depend on ITAR. 



ITAR * 0 

11 

3 D20.ll 

AYM, AYZ, ATARD 



ITAR =1 

11 

4D20.11 

RSVTAR(l), RSVTAR(2), RSVTARO), VSVTAR(l) 

12 

2D20.11 

VSVTAR(2), VSVTAR(3) 


The following 3 cards 

are needed only if ICOMV ■ 0. 

13 

4D20.11 

V(l, 1), V(l. 2), V(l, 3), V(2, 1) 

14 

4D20.11 

V(2, 2), V<2, 3), V(3, U V(3, 2) 

IB 

4D20.11 

v(3, 3) r,. ' " . •>. 



Program ETP2I3 


Card No. 

Format 

Parameters 

1 

4D20.11 

GAMMA, UDM, UTIME, UVELM 

2 

2 D20.ll 

ME, MM 

3 

3D20.11 

REVMAG, OINCD, ERRMXM 

4 

2 D20.ll 

TDAYO; TTRIPD 

5 

3 D20.ll 

VEVMAG, LOND, THED 

6 

4 D20.ll 

REMO(l), REM0(2), REM0<3), VEM0<1) 

7 

2 D20.ll 

VEM0(2), VEM0(3) 

8 

4 D20.ll 

EPS, EPSTSI, KDX, EPSV 

9 

415 

ICOMV, ITERMX, IFILEX, ITAR 


The next 1 or 2 cards depend on ITAR. 

ITAR - 0 

10 3 D20.ll AYM, AZM, ATARD 

ITAR * 1 

11 4D20.11 REVTARU), REVTAR(2), REVTAR<3), VEVTAR(l) 

12 2 D20.ll VEVTAR<2), VEVTAR(3) 

The following ^ cards are needed only If ICOMV = 0. 

13 4 D20.ll V<1, 1), V(l, 2), V(l, 3), V(2, 1) 

14 4 D20.ll V(2, 2»„ V(2. 3), V(3, 1) V($, 2) 

15 4D20.ll V(3, 3) 



Program PTP3I 


Card No, 

, Format 

Parameters 

1 

4D20.ll 

GL1. AUM, UTIME, UVELM 

2 

3D20.11 

MS. ME, MM 

3 

3D20.ll 

TSTART, TM, TEND 

4 

4 D20.ll 

RSEO(l), RSE0(2), RSE0<3), VSE0(1) 

5 

4 D20.ll 

VSE0(2), VSE0<3), RSM0(1), RSM0(2> 

6 

4 D20.ll 

RSM0(3), VSMO(i), VSM0<2), VSM0(3) 

7 

4D20.11 

RSVO(l), RSV0(2>, RSV0(3), VSV0(1) 

8 

2 D20.ll 

VSV0(2), VSV0(3) 

9. 

4D20.11 

VSVI(l), VSVI<2), VSVI(3), VSVMP{1) 

1 

10 

2 D20.ll 

1 

VSVMP(2), VSVMP(3) 

11 

. 4D20.11 

RSVTAR(I), RSVTAR<2), RSVTAR<3>, VSVTAR(l) 

12 

2D20.11 

VSVTAR(2), VSVTAR(3) 

13 

3D20.11 

KNR, ERRMIN, ERRMXM 

14 

3D20.11 

FMINM, EPS, EPSV 

18 

515 

ICOMV, ITLMAX, ILINC, ITDMAX, IFILEX 


the following 4 cards are needed only tf ICOMV => 0. 

16 

4D20.11 

V(l, 1). V(l, 2), V(l, 3), V(l, 4) 

. ' 17 

4 D20.ll 

V(2, 1), V(2, 2), V(2, 3), V(2, 4) 

18 

4D20.11 

V<3, 1), V(3, 2), V<3, 3), V<3, 4) 

10 

4 D20.ll 

V(4, 1), V(4, 2), V(4, 3), V(4, 4) 
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Program PTP3IS 
Card No. Format 

Parameters 

1 

4D20.11 

gamma, udm, utime, UVELM 

2 

2 D20.ll 

ME, MM 

3 

3 D20.ll 

TSTART, TM, TEND 

4 

4D20.ll 

REMQU), REM0(2>, REM0<3), VEMO(l) 

5 

2 D20.ll 

VEM0(2), VEM0<3) 

6 

4 D20.ll 

REVO(l), REV0<2), REV0(3), VEVO(l) 


7 

2D2jO.11 

VEV0(2), VEV0{3) 

8 

4D20.11 

VEVOPfl), VEV0Pf2), VEV0P(?>, \ EVMP(l) 

9 

2 D20.ll 

VEVMP'2), VEVMP(3) 

10 

4D20.ll 

REVTAR'l), REVTAP(2), REVTAR(S), VEVTa|f(1) 

11 

2D20.11 

VEVTAR(2), VEVTARO) 

12 

3D20.ll 

KNR, ERRMIN, ERRMXM 

IS 

3D20.11 

FMINM, EPS. EPSV 

14 

515 

ICOMV, ITLMAX, IUNC, tTDMAX, IFILEX 


The following 4 cards 

are needed only if ICOMV <= 0. 

15 

4 D20.ll 

V(l. 1). V(l, 2), VU, 3), V(l, 4) 

16 

4D20.11 

V<2, 1), V<2, 2), V(2, 3), V(2, 4) 

17 

4D20. 11 

V<3, 1), V{3, 2), V(3, 3), V(3. 4) 

10 

4 D20.ll 

V<4, 1) # V(4, 2 ), V(4, 3), V(4, 4) 



ALPHA 

ALPHAC 

ANGE . 

ANGM . 

ANGS 

ANGV 

ATARD 

ADM 

AYM 

AZM 

BETA 

DG 

DELX 
DC.O 
DRM 
DU VI 
DU VMM 
DUVMP 
DV ' 
nvi 

dvimag 

OVM 

I) VMM AG 


PROGRAM PRINTOUT DESCRIPTION 

Step size In search direction or Davldon algorithm paramete 
Step size in cubic Interpolation 
Subtended angle at earth. (deg) 

Subtended angle at moon (deg) 

Subtended angle at sun (deg) 

Subtended angle at spacecraft (deg) 

Parameter to define Halo orbit (deg) 

1 Unit of distance In meters 14-body) 

Parameter to define Halo orbit (meter) 

Parameter to define Halo orbit (meter) j 

Davidon algorithm parameter 

Cost gradient difference 

Change In Independent variables 

Cost gradient difference 

Change in interior impulse position 

Primer vector derivative at initial time 

Primer vector derivative before interior Impulse 

Primer vector derivative after interior impulse 

■Cost 

Impulse at initial time 
Magnitude of initial Impulse 
Interior impulse 
Magnitude of Interior impulse 
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DVMPX 

l.WF 

DVFMAG 
DVFMPS 
DVIMPS 
.. DVMPS 
DVMMPS 
DX 
DXC 
EPS 
EPSTSI 
EPSV 
ERR 

ERRMAX 

ERRMIN 

ERRMXM 

F 

FC 

FD 

FG 

FGS 

FMINM 

FS 

G 


Change in interior impulse 
impulse at terminal time 
Magnitude of terminal impulse 
Cost of terminal impulse (MPS) 

Cost of initial impulse (MPS) 

Total cost (MPS) 

Cost of interior impulse (MPS) 

Change in independent variables 
Change in independent variables 
Parameter to terminate Davidon iterations 
Allowable terminal constraint violation 
Factor to scale down variance matrix 
Constraint violation in Lambert iteration 
Allowable single step position error 
Allowable Lambert constraint violation 
Allowable single step position error 'meter) 
Cost 

Cost in cubic interpolation 
Cost 

Augmented cost 
Augmented cost 
Estimated cost (MPS) 

Cost 

Coat gradient 
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GAMMA 

GC 

GCMAG 

CD 

GC! 

GGS 

GL1 

GMAG 

GS 

GSMAG 

H 

IT DAY 

1COMV 

I FILE 

IFILEX 

l LING 

IMODE 

IMTX 

IPT.JX 

IPTHAJ 

IPV 

IPVTM 

ISTEP 

ITAR 


Parameter to define lib ration point (3 -body) 

Coat gradient in cubic interpolation 
Magnitude of cost gradient 
Cost radient 

Augmetned coat gradient 
Augmented coat gradient 

Parameter to define Ll lib ration point (4-body) 

Magnitude of cost gradient 

Cost gradient 

Magnitude of cost gradient 

Computed step size in state extrapolation 

Step size in days 

Flag to compute variance matrix 

Flag to file trajectory data 

Flag to file trajectory data 

Number of Lambert increments 

Flag to select mode of initial condition 

Flag to compute state transition matrix 

Flag to print trajectory 

Flag to print trajectory 

Flag to compute primer vector 

Flag to monitor primer vector magnitude history 

Number of integration steps 

Flag to compute target position and velocity on Halo orbit 
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I TDM AX 

ITER 

ITERD 

l TER I* 

ITERMX 

ITLMAX 

KDX 

KNR 

KV 

LDM 

LDTM 

LO'ND 

LM 

I.T 

LTM 

ME 

MM 

MS 

OBLD 

OINCD 

P 

PC 

PV 

PVO 


Maximunv number of Davidon iterations 

Number of iteration in Lambert routine 
Number of Davidon iterations 
Number of Lambert increment 
Maximum of Davidon ite rations 
Maximum number of Lambert iterations 

Parameter to scale Independent variables in constraint restoration 

Parameter to scale independent variables in Lambert iteration 

Parameter to scale variance matrix 

Derivative of primer vector magnitude 

Derivative of maximum primer vector magnitude 

Longitude of ascending node (deg) 

Magnitude of primer vector 
Constraint gradient matrix 
Maximum primer vector magnitude 
Gravitational constant of earth 
Gravitational constant of moon 
Gravitational constant of sun 
Obliquity angle (deg) 

Orbital inclination (deg) 

Davidon algorithm parameter (iteration stops if P is less 
than EPS in ETP2I or ETP2I3) 

Davidon algorithm parameter 

Primer vector and derivative 

Primer vector and derivative at initial time 



P VMM AG 
FVPMAG 
F 

RC 

RC MAG 

RDED 

RDL1P 

RDM1) 

RDSD 

HDVD 

RKL 

REM 

REMO 

HEMF 

REV 

REVF 

REVM 

REV MAG 

REVMX 

REVO 

HEVMD 

REVTAR 


Projection of primer vector derivative on primer vector 
before Interior impulse 

Projection of primer vector derivative on primer vector 
after interior impulse 

Davidon algorithm parameters 

Davidon algorithm parameters in cubic interpolation 
Magnitude of RC 

Position of earth in rotating coordinates 

Position of LI libration point in rotating coordinates 

Position of moon in rotating coordinates 

Position of sun in rotating coordinates 

Position of spacecraft in rotating coordinates 

Position of libration point wrt earth 

Position of moon wrt earth 

Position of moon wrt earth at initial time 

Position of moon wrt earth at terminal time 

Position of spacecraft vr rt earth 

Position of spacecraft wrt earth at terminal time 

Position of spacecraft wrt earth at interior impulse time 

Distance of spacecraft to earith 

Change of position of spacecraft wrt earth at interior 
impulse time 

Position of spacecraft wrt earth at initial time 
Position of spacecraft wrt earth at interior impulse time 
Target position wrt earth 
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HJ.TARL 

Target position wrt libratlon point 

KM AG' 

Magnitude of R, 

HMV 

Position of spacecraft wrt moon 

RMVF 

Position of spacecraft wrt moon at terminal time 

HMV MAG 

Distance of spacecraft to moon 

RSE 

Position of earth wrt sun 

HSd'O 

Position of earth wrt sun at initial time 

HSEF 

Position of earth wrt sun at terminal time 

HSU 

Position of LI lib ration point wrt sun 

HSM 

Position of moon wrt sun 

HSMO 

Position of moon wrt sun at initial time 

KSMF 

Position of moon wrt sun at terminal time 

RSV 

Position of spacecraft wrt sun 

HSVO 

Position of spacecraft wrt sun at initial time 

RSVF 

Position of spacecraft wrt sun at terminal time 

RSVM 

Position of spacecraft wrt sun at interior impulse time 

hsvmag 

Distance of spacecraft to sun 

USVMD 

Position of moon wrt sun at interior impulse time 

HSVMX 

Spacecraft position wrt sun at Interior impulse 

HSVTAH 

Target position wrt sun 

RTM 

Position of spacecraft at maximum primer vector magnitude 

S 

Davidon algorithm search direction 

sc:; 

Projection of cost gradient on search direction 

SOS 

Projection of cost gradient on search direction 
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T 

Time 

TO 

Initial time ^ 

TDAY 

Time in day 

TDAYO 

Initial time in day 

TOAYF 

Terminal time in day 

TEND 

Terminal time 

TESTR 

Magnitude of constraint violation 

TESTRD 

Magnitude of constraint violation 

TESTRS 

Magnitude of constraint violation 

TF 

Terminal time 

THE!) 

Position of spacecraft from line of node (deg) 

TM 

Interior impulse time 

TRIPI) 

Trip time in day 

TSI 

Constraint violation 

TSID 

Constraint violation 

TSIS 

Constraint violation 

TSTART 

Initial time 

TTM 

Time of maximum primer vector magnitude 

TTR1P 

Trip time 

TTRIPD 

Trip time in day 

UDM 

1 Unit of distance in meters (3 -body) 

UTIME 

1 Unit of time in days 

IJVELM 

1 MPS in dimensionless velocity 

UVF 

Unit vector of terminal impulse 
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UVI 

UVM 

V 

VDED 

VDL1D 

VDMD 

VDSD 

VDVD 

VEL 

VEM 

VEMO 

VEMF 

VEV 

VEVO 

VEVOP 

VEVMP 

VEVMPX 

VE VP 

VEVMAG 

VEVMPD 

VEVMPS 

VEVTAH 

vrr 

VLTARL 


Unit vector of initial Impulse 
Unit vector of interior Impulse 
Variance matrix 

Velocity of earth in rotating coordinates 

Velocity of LI lib ration point in rotating coordinates 

Velocity of moon in rotating coordinates 

Velocity of sun in rotatLng coordinates 

Velocity of spacecraft in rotating coordinates 

Velocity of libration point wrt earth 

Velocity of moon wrt earth 

Velocity of moon wrt earth at initial time 

Velocity of moon wrt earth at terminal time 

Velocity of spacecraft wrt earth 

Velocity 6f spacecraft wrt earth at initial time before impulse 

Velocity of spacecraft wrt earth after initial impulse 

Velocity of spacecraft wrt earth after interior Impulse 

Spacecraft velocity wrt earth after interior Impulse 

Velocity of spacecraft wrt earth at terminal time 

Magnitude of spacecraft velocity wrt earth 

Velocity of spacecraft wrt earth after interior impulse 

Magnitude of spacecraft velocity wrt earth in MPS 

Target velocity wrt earth 

Initial velocity in Lambert iteration 

Velocity of target wrt libration point 
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VMV 

VMVF 

VvSE 

VSEO 

VSEF 

VSL1 

VSM 

VSMO 

VSMF 

V'SV 

VSVI 

vs.vmpx 

VSVF 
VSVMP 
VSVMPD 
VS VO 
VS VTA ft 

vtm 

x 

xc 

XD 

xs 


Velocity of spacecraft wrt moon 

Velocity of spacecraft wrt moon at terminal time 

Velocity of earth wrt sun 

Velocity of earth wrt sun fet Initial time 

Velocity of earth wrt sun at terminal time 

Velocity of LI lib-ration point wrt sun 

Velocity of moon wrt sun 

Velocity of moon wrt sun at Initial time 

Velocity of moon wrt sun at terminal time 

Velocity of spacecraft wrt <ttun 

Velocity of spacecraft wrt sun after Initial Impulse 
Spacecraft velocity wrt sun after Interior impulse 
Velocity of spacecraft wrt sun at terminal time 
Velocity of spacecraft wrt sun after interior Impulse 
Velocity Of spacecraft wrt sun after interior impulse 
Velocity of spacecraft wrt sun at initial time before impulse 
Target velocity wrt sun 

Velocity of spacecraft at maximum primer vector magnitude 
Independent variables in Davidon iterations 
Independent variables in cubic interpolation. 

Independent variables 
Independent variables 



Subroutine FOUR BY 


A. Input Parameters 


Parameter 

Symbol 

XTO 

*o 

XTF 

V 

RSVO 

**SV*V 

VS VO 

W 

RSEO 

R SE ( V 

VSEO 

V SE (t o ) 

RSMO 

R SM*V 

VSMO 

^SM ( V 

PVO 

Tit©), T(t© 

B, Output 

Parameters 

RSVJV 

TT gv (t f ) 

VSVD 

y S v ( v 

RSED 

R SE<V 

VSED 

V SE<V 

ItSMD 

^SM ( V 

VSMD 

V SM (t f > 

Sll, S12, S21, 

S22 V (t f# t©) 


Definition 


primer vector and derivative 


State transition matrix 


C. 


Computation 

Step 1. Initialize running variables equal to input states. 

Step 2. Call FVEMV to compute R EV , V EV ' R MV' V MV' R EM' V EM' 

« * » » »« » » • • » » 

Step 3. Call CSTEP to compute step size h, < RSV , < rsE' *RSM and 
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Step 4. 


Step 5. 


Step 6 . 


Step 7. 


Call DISP 

If IPV - 1> call PVEC. 

If IFILE = 1, call FDATA. 

If I PTH A J = 1, call PTRAJ. 

Call TWOBDY to compute 6 conica: 


L R sv» 

V sv] 

[^SE' 

^se] 

L R SM’ 

v sm] 

[^EV* 

^Ev] 

[ R MV j 

V Mv] 

L R EM‘ 

• V .'em] 


Compute 3 perturbation vectors. Let 
D^l j] = CONIC of i with respect to l 

B 1 = reference trajectory of j with respect to l 
*i 3 


dR gv 

11 

"5 

CO 

< 

- R sv (0) - 

h V sv (0> 

dV sv 

= [ v sv] 

- v sv <0) 


dR SE 

= [ r se] 

“ r se*°* “ 

h v SE (0) 

dT SE 

= M 

■ V SE (0) 


dR SM 

C^SM. 

1 * r sm (0) 

- hY SM <0 > 

dT SM 

“ l V SM. 

! - v SM <°> 
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dR EV “ 1 

/ 

5ev] 

-B EV (0)-hV EV (0) 


' ^EV « | 

l t ev] 

-v EV <o) 


dR MV s ! 

[ r mv. 

l- R MV <0) - h ' V MV (0 > 


dV MV = 

[ V MV. 

! - t mv ,0 > 


dR EM 

[ r em. 

].R EM (°)-hV EM (0) 


dV EM 

L v em. 

]-v EM ( 0 ) 


Approximate perturbations 

T) 

“E . 

-IT? 4 

- dR + ^ dRniv* + 

r RSV 

m s + m e 

jE SE 

a±t EV , SM MV 



AW 

f dV" + + dV. - 

r vsv 

m s + Me 

dV SE 

av EV , SM MV 

+ 

f) 

. m m 


- " M 

•RSE 

. Ms + M M 

dK SM 

urv EM 

Me m m 


Mm 

H TT 

- dV^ 

*VSE 

M s + M m 

dV SM 

Me + Mm 

P 

Me 

HR 

4- ^ 

r RSM 

m s + m e 

dW SE 

EM 

Me m m 

p 

Me 

M j , , . . 

tixf . ■ 

+ Me dV-p*. 

1 VSM 

>*S + »‘E 

■RE 

EM 

»*J2 + »*M 

Step 8. 

Compute reference trajectories 


R 

SV 

[ R sv] + P RSV 


V 

SV 

[ v sv] + P VSV 
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r se e 1 

l R Se] 

+ P RSE 

V SE = 1 

L v se] 

+ P VSE 

^SM = ; 

[ r sm. 

1 + P RSM 

V SM e 

L v sm. 

! +? vsm 

r ev * 

■ r se 

+ ir sv 

V EV 

" V SE 

■ +V BV 

¥ mv b 

■ r sm 

+ S sv 

V MV " 

■ V SM + V SV 

r em * 

* r se 


V EM " 

’ V SE 

+ T sm 

t = 

t + h 



Step 9. Call DELRV to compute corrections. 

Step 10. Correct state vectors. 

Step-11. If IMTX ■ 1, update state transition matrix. 

Step 12. Call DISP 

Step 13. If tPV - l, call PVEC, 

If (FILE * 1, call FDA TA. 

If IPTRAJ « l f call PTRAJ 

Step 14. If t a t f . exit. 

Step 15. Call CSTEP. 

Go to Step 6. 
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Subroutine THRBDY 


A. Input Parameters 


Parameters 

Symbol 

Definition 

XTO 

*o 


XTF 

‘f 


REVO 



VEVO 

V EV*V 


REMO 



VEMO 

V EM (t o ) 


PVO 

X t 


B. Output Parameters 


REVD 

R kv*V' 


VEVD 



REM1) 

H EM*V 


-VEMD 

Wr> 


Sll, S12, S21, S22 

fP <t f , t o ) 

State transition matrix 

C. Computation 


Step 1. 

Initialize running variables equal to input states- 

Step 2. 

Call CSTEP3 to compute step size h, < REV and J. 

Step 3. 

Call DISP3 


Step 4, 

If IPV = 1, call PVEC 



rr I FILE “ 1, call FDATA3 
if IPTRAJ = 1, call PTRAJ3. 


Step 5. Call TWOBDY to compute 3 conics: 



Step 6. 


Step ?. 


Step 8. 
Step 9. 
Step 10. 
Step 11. 



[^EV, V Ev] 


[^EM‘ V EmJ 


[\v’ V Mv] 

Compute perturbation vector 
P RE V * [ R Mv] ‘ R MV (0) “ 

P VEV 

Compute 

■ [ V M V ] ’ W 0) 
reference trajectories 


'EV 


[^Ev] 


+ P 


REV 


V, 


% 


EM 


[ V E v] + * 
[ r em] 


V EM " [ V Em] 


r mv s ” R EM * R EV 


V MV * " V EM + V EV 


t ° t + h 


Call DELRV3 to compute corrections. 
Correct state vectors. 

If IMTX = 1, Update state transition matrix. 
Call DISP3 
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Step 12. If IPV ■ 1, call PVEC. 

If IFILE * 1, call FDATA3. 
If 1PTRA.I = 1, call PTRAJ3. 

Step 13. If t * t f , exit. 

Step 14. Call C STEPS. 

Go to Step 5. 



Subroutine TWOBDY 

A. Input Parameters 


Paramete rs 

Symbol 

Definition 

XRO 

Wt) 


xvo 

V{t) 


TAU 

h 

Step size 

MU . 

>4 

Gravitational constant 

PSI 

* 

Generalized eccecntric anomaly 

IMTX 

! mtx . 

Flag to compute state transition 
matrix: 1^ K 0, no 

1, yes 

B. Output 

Parameters 


XRF 

■R<t+h) 


VRF 

V(t+h) 


PSI 

* 


P 

ip (t+h.,. t) 

State transition matrix 


C. Computation 
See Ref. (3). 


4P 



Subroutine CSTEP 

A. Input Parameters 


Parameters 

Symbol 

Definition 

ERRMAX 

f max 

Allowable single step position error 

REV 

«EV (t) 


USE 



RSV 

*sv (t) 


RMV 

^MV (t) 


RSM 

*W*> 


REM 



TC.0 

tgo 

‘ft 

B. Output Parameters 

H h 

Step size 

DR4RSV 

€ RSV (t) 
• '* * * * 

4th Derivative of position error 

DR4RSE 

e RSE (t) 

* ’ -r , ■ 

estimates 

DR4R5M 

* RSM * „ 


BIG.T 

J 

\°3 >3 ) 


C. Computation 
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RSV 


(t) 


11/ „ „ - T\ /^EV , *SE N \ 

’* sMeL ^ ( sv “ sv )( ^7 


1 f „ T\ / R SV R SE \1 

+ r — ? ( l ■ 3 ^EV U EV ) \p ? ‘ p -1 
R E v ’ R SV r se 

r i / ' * _ - t\ / r mv r sm \ 

+ "s t-T (' ■ 3 U SV U SV ) ( 5-7 ^ 7 ) 


sv 


MV SM 


1 ( - t\ / R sv r sm \n 

+ 7“^ (* ' 3 ®MV “MV ) (77 775) J 


MV 


"Rgv" R SM 


r 1 / _ _ tw r mv . r em 

+ me^L^I 1 - 3 ^^ H5-S ^7 


R. 


Ro, 


R 


1 / a _ - T\ / EM _SM\ 

— ST V 1 “ 3 U SE U SE ) t 5 ~ 


SE 


Vr em r sm 


1 / - t\/ r ev r em \ 

+ — j (1 - 3 ir M v u MV j ^ J - 

r mv ■' r ev k em 

1 / r , ^ - t\ / r em A y yi 

+ ^ y V ~ 3 ^SM U SM / \p 3 p 

r sm k em se 


( 24 ) 


1/4 


'RSV 


u sv 

= UNIT (E sv > 

U EV 

= UNIT (^ EV ) 

%v 

= UNIT <E mv ) 

“SE 

= UNIT <R se ) 

ff SM 

= UNIT (Tt SM ) 
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Subroutine CSTEP3 


A. Input Parameters 


Parameters 

Symbols 

Definition 

ERRMAX 

€ max 

Allowable single step position error 

REV 



RMV 

\v (t) 


TGO 

tgo 

Terminal time - present time 

B. Output Parameters 


H 

h 

Step size 


» # » « 

4th Derivative of position error 

DR4REV 

*REV (t) 

estimate 



..('a hI 0 

BIGJ / 

J 

" \°s hi 

C. Computation 


f. ... n TW-MV ^ 

• • • * 

I 1 1 

*REV {t) 

« EV 

V 1 3TT EV U £V H -y s ) 

h mv *em 


+ — ^ (i - 3 u M v u mv T ) (' 

1 / 


r ev r em 


MV 


r ev r em 


■)> 


f HEM (t) “ ° 


h = (24^L) 
*REV 

• UNIT(R EV ) 


1/4 


tr«at» “ UNIT (R^y) 


‘MV 


All quantities are evaluated at the beginning of an Itegration step. If h is 
greater then tgo, It is set to tgo for the l&Bt step. 
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{Subroutine 

A. Input Pa ramete r b 


Parameters 

Symbol 

H 

h 

HSV 

R sy (t+h) ' 

REV 

. . . R EV (t+h) 

RMV 

^MV (t4il) 

• 

USE 

^SE ,m) 

RSM 

lf SM <t+h) 

REM 

R EM <t+h) . 

CRSV 

[T? sv (t + h)] 

(! REV 

r L 1? r . v ( t+h)] 

CRMV • 

L^V (t+h '] 

CURE 

[ff s ,,,(t+h ) ] 

CRSM 

l R SM< t+ *>] 

OREM 

L R EM (t+h) ] 

DH4RSV 

€ RSV (t) 

DR4RSE 

t RSE (t) 

DR 4 RSM 

*RSM (t> 


R, Outp ut Parameters 

RRSV 
RVSV 
RIISE 
RVSE 
HRSM 

RVSM dV SM (t+h) J 


DELBV 

Definition 
Step size 


Conic a plus perturbations at end 
of step. 


Conics at end of step 


4th derivative of position error 
estimates at beginning of step. 


Position and velocity corrections 
computed by quadrature formula. 


dT? sv (t+ h ) 

dV sv (t+h) 

dB"gp,(t+b) 

dV SE (t+b) 

dl W t+h) 
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C. Computation 
Define 


**T — j 

L R i. i <t+h> ] 


\ 3 

l| 

[\ j < t+h >] 1 

Pi. 

(i, j) = (SV, EV, MV, 

SE, S 


The second derivatives of Stumpff-Wetes position errors are given by 

r u R sv c s ^m ¥ sv + ^e (®se +i ev) + (*sm + °mv) 

„ SK ■ (m s + He)*SE + (*SM - t em) 

\ rsm = (^s + + (^se + ^em) 

The position and velocity corrections are computed by quadrature formulas i 

below. 


dR SV 

- * 2 i 

V C RSV T * *1, RSV / 

dV sv 

h 

• h 2 , ^ N 

= *( 

€ RSVF +< l, RSV / 


h 2 

b 2 *£. \ 

° W 

T + ll, MSI;:/ 

dV SE 

■|( 

h2 +f- ^ 

. C RSE~6“ c i, rse/ 

dR SM 

h 2 

" 2tr 

/ ♦ • ' * h 2 -ii. 

l ( RSMT + \ RSM 


Vi i 

h 2 :-L. ■ \ 

d "sM 

- ?< 

^ € RSM "6" + % RSM/ 
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Subroutine 


A input Parameters 

Parameters 

Symbol 

H 

h 

REV 


RMV 

» MV (t+h) 

CREV 

L B EV (t+h) ] 

CRMV 


DR4REV 

*REV (t) 


DELRV3 

Definition 
Step size 

Contes plus perturbations at end 
of step. 

Conics at end of step. 

4th derivative of position error 
estimate at beginning of step 






Subroutine COMIC 


A, Input Parameters 


Parameters 

Symbol 

Definition 

hevmAg 


Pev^o^ 

VEVMAG 

v o 

i V EV + M 

LON 

Q (rad) 

Longitude of ascending node 



Position of vehicle from ascending 

THE 

0 (rad) 

line of node in orbital plane. 

OJNC 

t (rad) 

Orbital inclination 

OBL 

OBL (rad) 

Obliquity angles 

RSEO 

. ^SE ( V 


V S.L5Q 

%5E (t o* 

' ; ' 1 

13. Output 

Parameters 


REVO 

R EV^o* 


VEVO 

V EV (t o' 


RSVO 

^SV (t o> 


VSVO 

v sv -(t o ) 

Velocity before impulse 

vsvi 

7 SV + V 

Velocity after impulse 


C, Computation 

Matrix to transform a vector from C-frame to e-lrame: 


( cos.O -sin C2 0 \ /I 0 

sin ft cos Cl 0 I I 0 cos i 

0 0 1 / \0 sin i 

Matrix to transform a vector from e-frame to E-frame: 


0 


^cos 0 -sin 0 0 


-sin i| I sin 0 cos 0 


cos i 



0 


= I 0 cos (OBL) stn (OBL) 
,0 -sin (OBL) cos (OBL), 


EV o 


V EV + < t o ) 



^sv <t 0 > = + R EV (t G ) 


^SV + ^o ) * V SE <t o ) + V EV ( V 
V K v-« 0 ) = UNIT(v EV + (t 0 >; 

V sv '«o> = ”sE ( ‘o> +7 Ev'«o» 
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Sub routine COMIC 3 


A. Input Parameters 


Parameter 

Symbol 

Definition 

PE V MAG 

r o 

^EV (t o>l 

VEVMAG 

V 

o 


CON 

n (rad) 

Longitude of ascending node 



Position of vehicle from ascending 

THE 

0 (rad) 

node in orbital plane 

OINC 

i (rad) 

Orbital inclination ■ 

B. Output Parameters 


HE VO ■ 

S EV (t o> 


VE VO 

V Ev'«o> 


VEVOP 

V EvX> 


C. Computation 




Cq » matrix to transform a vector from O-frame to e- frame 
(given in COMIC) 



tt o> 






S' 


Subroutine COMFG 

A. input Pa rameters 


Parameters 

Symbol 

Definition 

T START 

t 

o 


TEND 

V 


•REV MAG 

r o 

l«EV (t o , l 

VEVMAG 

v o 

I^ev + M 

LON 

0 (rad) 

•Longitude of ascending node 



Position of vehicle from ascending 

THE 

0 (rad) 

node in orbital plane 

OINC 

i (rad) 

Orbital inclination 

OBL 

OBL (rad) 

Obliquity angle 

RSEO 

VV 


VSEO 

V SE ( V 


RSMO 

.. R SM ( V 


VS MO 

v smV 


B. Output 

Parameters 


FJ) 

AV 

AV = iv SVTAH - 

TESTRn 

i 


CiD 

f 

_ 5 A V 

8. " b <V D , 0. S) 

TSID 

. ? 

^ = H SV ( V " r svtar 

LTD 

Sll, S12, S21, 

l t 

S22 <p (t f , t Q ) 

t T_ 

L " b (v jrnrsy 
S (?S-V <t f^ V sv (t fi) 

»$sv<V- v sv«o) 

TJV1 . 

U VI 

Uvi = t)NL T (v s v + ( t 0 )-V sv -( t o)) 
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DVF 

C. 


^VF 


Nf 1 UNIT ( v svtak - v sv (t f>) 


(Computation 


x - (v Q , 0, 0) 


Call COMIC to compute Rg V <t o >, V Sv" (t o ) ’ V SV 
Call FOUR BY to advance states to t f and compute <p. 

For the first Iteration, call CTAR to compute r S vtAR* V SVTAR' 

= V SV (t o ) " V SV V 


Ti VI ■ UNIT (AV q ) 


AV f ° V SVTAR ' V SV ( V 


TT vf = UNIT <AV f ) 


Av r T > a a v sv<V\ 

22 —^—; 


L(, r ,lW +0i 


AV = |AV f l 

- . „ aAv 

« " I7"V K 2i 

dx AV d x 

0 = R sv (t f ) ” r svtar 

alwttj aV sv (t o ) 


1, 




SV o 


+ <Pi 


ax 11 ax 12 ax 


R SV (t o ) = R SE ( V + n Ev*V 


v sv (t 0 ) - v SE (t 0 ) + v EV + (t b > 

3 R S v(t 0 ) _ 


= A 


&x 


a x 
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Ad, i) 
A(l, 2} 
A<I, 3) 
A(2, 1) 
A<2, 2) 
A(2, 3) 

A(3, 1) 
A(3, 2) 
A<3, 3) 

BV SV (t o ) 

ax 

13(1, 1) 
B(l, 2) 
B(l, 3) 
B(2, 1) 

B<2, 2) 
13(2, 


** O 

= r (-sin O cos 0 - cos CJ cos i sin 0) 
o 

= r Q (-cos O sin 0 - sin 0 cos i cos 0) 

= 0 

= r cos <OBL) (cos O cos 0 - sin Q cos i sin 0) 
o 

- r [cos (OBL) (-sin O sin 0 + cos 0 cos i cos 0) 
+ sin (OBL) sin i cos 0] 


= 0 


s - r sin (OBL) (cos O cos 0 - sin ft cos i sin 0) 
o 


■s r [-sin (OBL) (-sin ft sin 0 + cos ft cos i cos 0) 
o 

+ sin (OBL) sin i cos fl} 

a v,., v + <tJ 


EV 'V 
air 


* B 


= - cos ft sin 0 - sin 0 cos i cos 0 

= v (sin ft sin 0 - cos ft cos i cos 0) 
o 

= v (- cos ft. cos 0 + sin ft cos i sin 0) 
o 

= cos (OBL) (-sin ft sin 0 + cos ft cos l cos 0) 

+ sin (OBL) sin l cos 0 

= v cos (OBL) (-cos ft sin 0 - sin 0 cos i cos 0) 
o 

= V (cos (OBL) (-sin ft cos 0 - cos 0 cos l sin 0) 
o 

- sin (OBL) sin i sin ft] 
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B(3, 1) » - sin (OBL) (-sin O sin 0 + cos U cos i cos 0) 

+ cos (OBL) sin i cos 0 

B(3, 2) = - v Q sin (OBL) (-cos Cl sin 6 - sin Cl cos i cos 0) 

B(3, 3) = v Q [-sin (OBL) (-sin Cl cos 0 - cos Cl cos i sin 0) 
- cos (OBL) sin i sin 0] 
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Subroutine COMFG3 

A, Input Parameters 


Parameters 

Symbol 

Definition 

TSTART 



TEND 

*f 


REVMAG 

r 

o 

l R EV^o^ 

VEVMAG 

V 

o 

l V EV 

I. ON 

P (rad) 

Longitude of ascending node 
Position of vehicle from ascending 

THE 

0 

node In orbital plane 

OINC 

i (rad) 

Orbital inclination 

REMO 

^EM^V 


VEMO 

V EM ( V 


B. Output Parameters 


FD 

AV 

AV * l V EVTAR “ V EvM 

TESTRD 

c 

c “ W 1 

GD 

I 

r ■ * w o , nrer 

TSID 

J 

^ = r ev ( V " r evtar 

LTD 

l t . 

■ t T_ bf 

L ’a (v o : a 6) 

Sll, S12, S2I, S22 

<p V 

a(R EV (t t ).:v EV (t f )) 

a (^EV ( V» "^EV (t o ) ) 

tw. u 

”vi 

«vi ■- UN1T ( V E vV -■ 

UVF 

”VF 

¥ VF = UNIT (y EVTAR ■ V EV ( V) 



Computation 

Call COMIC'S to compute ^ RV (t 0 ). ^ EV " (t 0 >* 

Call TIM? BOY to advance states to t f and compute <p. 

For the first iteration, call CTAR3 to compute R E vtAR and V EVTAH' 
Equations are same as in COMFG with cos (OBL) = 1 and sin (OBL) ■ 0. 






Subroutine 


A. Input 

Pa rameters 

Parameters 

Symbol 

RSEF 

^SE*V 

VSEF 

V SE*V 

RSMF " 

iWV 

VSMF 

V SM (t f ) 

me ME 


VEMF 

V EM- V 

AY 

Ay 

AZ 

Az 

AT ATI 

At ah. 

B. Output Parameters 

HSVTAIi 

^SVTAR 

VSVTAU 

V s ■ 

v SVTAR 


C. Computation 


CTAR 

Definition 


Parameters to define a point on 
a Halo orbit. 


Position and velocity of 1^ in S- frame: 
u S = (l " ■ y Li ) ( k sh; " + 


'em / 


^E + ^M 


V S 
V SL1 


< l - *u> ( 


SE 


^E + ^M 




If- both A and A z are zero, the following computation is omitted and target 
position and velocity are set equal to that of-Lj. Define L- frame unit vectors. 

■ ' S.L S = UNIT (*SU S ) 

= UNIT ( m e r se S X V SE + X V SM ) 



_ S _ s — s 
U YL = U ZL XU XL 

The matrix to transform a vector from S c frame to L-frame Is given by 

c s L = (Owf - . (^V 

The angular velocity of L-frame with respect to S-frame In S-frame is 
defined by 


V ® 

_ s s {- S V SL1 A 

W SL S U ZL \ YL 


The target position and velocity in L-frame are defined by 


I? 


L 


LI TAR 


A y sin A TAJt 

Ay cos A tar 


Az sin A 


TAR 


where 


V 1 

v LI TAR 


a> 


*n 

Ay 

COB A tar 

w n 

Ay 

sin a tAr 

w n 

Az 

cos A tar 

+ J 

/.SB , 

(t, 

6 

> ~ 2B l 


B t = ■ l . # + -V- 

77-^ % 


X <! ' VvF ' 


^E + 

■ M ” : 

< 1 s + <‘e + »*m 

2 “n 

k - 5 — — 

co +(2 B t +1) 
n i- 

The target position and velocity in S-frame are then given by 

T 


r svtar 2 * * S * r sli S + ( c s L ) R 


LI TAR 


V SVTAR S = V SL1 S + C C S L ) V — **"■+&** * 


L , rr S 
L1TAR +W SL 


(c s L ) T « 


L1TAR 
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Subroutine CTAR3 


A. input Parameters 

Parameters 

Symbol 

REMF 

. . : \m ( V 

VEMF 

^EM^V 

AY 

Ay 

AZ 

Az 

ATAR 

a tar 

H. Output 

Parameters 

REVTAR 

IT ' 

*EVTAR 

VEVTAR 

\T ' 

v EVTAR 


Definition 
In e -frame 

Parameters to define a point on 
a Halo orbit 


C.! # Computation 

Position and velocity of libration point In e- frame 


w e 

r el 

= (1 " y) 

y > 0 for L 1 

V EL 6 

E a-y)v EM e 

< 0 for L, 


If both Ay and Az are zero, the following computation is omitted and target 
position and velocity are set equal to that of the libration point. Define A-frame by 
unit vectors; 


— . e 
U XL 

■ UNIT(Tf EL e ) 

e 

U ZL 

‘ UNIT (B EM e 

e 

— e — e 

U YL 

‘ U ZL x XL 




The matrix to transform a vector from e-frame to A-frame is given by 

c. 1 ■ ((%:)" (*yl , ) T . 
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The angular velocity of A-frame with respect to e-frame in e-frame is 
defined by 


__ e -:.:et e, Y El? \ 
W EL * U ZL Kl e|) 


The target position and velocity in A-frame are defined by 

* 

k 


where 


IT. 


A 


LTAR 


LTAR 


Ay 

sin A tar \ 

Ay 

cos A tar J 

Az 

sin A tar J 


Ay cos Arp AR 

“n 

Ay sin A,p AR 

w n 

Az cos Arp AR 




B L 

T" 


,3B, 


) - 2 


B « .. L - J* + -^ 
L a - y > 3 v 3 


k = 


> E + t* M 

2ui n 

u n 2 + (2 B l + 1) 


The target position and velocity in e-frame are then given by 

A 


e - n e 
'EVTAR EL 




RTnt/rr> a ~ R-pt * (,^e ^ B LTAR 


V EVTAR B V EL + 


(*/) 


tt A. + Z5 e 
LTAR “EL 




V T ~ x (c^) R LXA r 
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Sub routine C OMDX 


A. Input Parameters 
Parameters Symbol 

LTS L T 


Definition 

aj - 
a (v Q , n, 8) 


J,S l 

TSIS 0 


R fd s r svtar or 


B. Output Parameters 

OX dx dx" = (dv Q> dCl, d0) 

C. Computation 

dx = - L (L T L)‘ 1 J 


EVTAR 
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Subroutine HVEMV 


A. 

Input Parameters 

Parameters 

RSV 

Symbol 

5 SV<t> 

vsv 


v sv^ 

RSE 


*SE {t) 

VSE 



RSM 


*SM (t) 

VSM 



R. 

Output 

Parameters 

REV 


R EV (t) 

VEV 



RMV 


*MV (t> 

VMV 


' V MV^> 

REM 


.. R EM (t) 

VEM 


V RM (t) 


Definition 




C. 



Co mputation 


rT 

< 

ii 

- R SE 

+ R sv 

V EV * 

" V SE 

+ Y sv 

II 

> 

!, S 

“ r sm 

+ R S V 

V MV 

“ V SM 

+ V SM 

r em 

^SE 

+ r sm 

"v ■ = 

EM 

“ t se 

+ V SM 


This subroutine is used in 4-body program only. 
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Subroutine UPX 


A . I nput P ara meter a 


Parameters 

Symhol . 

Definition 

XD 



FD 

V 


TESTR D 

fiTji: 


GD 



TSID 



LTD 

«L T ) d 


1/D 

L d 


fgd 


(f + p T ‘iD i 

GGD 


<f + Ll?) d 

SUD, S12D # 
S21D, S22D 

<P d ( *r- ‘o' 


II VI I), PVFD 




B. Output Parameters 

Same as Input parameters relabelled as X, F, TESTR G, TSI, LT, L 
FG, GG, SU. S12, S21, S22, UVl, UVF. 

C. Computation 

Set output parameters - Input parameters with new names. 
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Subroutine LAMB 

A. Input Parameters 


Parameters 

Symbol 

Definition 

TO 

*0 


TF 



JRSV 

^Sv'V 


vsv 

. T sv<V 

Initial estimate 

RSE 

R SE*V 


v*si»: 

VV 


RSM 

*WV 


VSM 



KNR 


Lambert iteration parameter 

I.TLMAX 


Maximum number of iterations 

ERRMIN 


Convergence criterion 

HSVTAJ1 

^SVTAH 


ft, Output 

Parameters 


JIS VP 

*sv<V 


VSVF 

v sv ( V 


HSTCF 

R SE ( V 


VSFF 

w 


. HSMF 

lT SM (t f ) 


VSM P 

• V SM ( V 


VSV 

< 
r+* ' 

Final solution 

Sll, S12, S21, 

S22 p(t f , t Q ) 

State transition matrix 
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C. Computation , 

Call FOUR BY to advance states to Newton- Raph son method is used which 
iterates on V w (t ) until terminal constraint violation is less then ERR MIN or the 
number of iteration exceeds ITERL. The desired change in Initial velocity is given 

by 

dV = - <<P 12 > -1 (^SVTAR " R SV ( V) 

The subroutine has a built-in safeguard against inversion of a singular matrix 
when the transfer is 2-dimensional. 

V). inter nal Parameters 


Dummy iteration variables or 
initial velocity. 


ERR 


Error vector of terminal constraint 
violation 


TESTR 


Magnitude of ERR. 
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Subroutine LAMB3 


A. Input Parameters 


Parameters 

Symbol 

Definition 

TO 

*o 


TP 



REV 

«EV<V . 


VEV 

‘VV 

Initial estimate 

REM 

R EM ( V 


VEM 

V EM (t o ) 

• i 

KNR 



ITLMAX 



ERRMIN 



RE V TAR 



B, Output 

Parameters 


RE VF 

*EV<V 


VEV F 



REMF 

^wv 


VEMF 

V EM ( V 


VEV. 

. V EV<V 

Final Solution 

Sll, S12, S21, 

S22 <p (t ff t Q ) 



C. Computation 

Call THRBDY to advance states to Use Newton- Rapheon method to 

iterate on V„, r (t ) until terminal constraint violation is less then ERRMIN or the 
EV O 

number of iteration exceeds ITERL. 

The desired change in initial velocity is given by 

dV * " <<P 12 )-1 (R EVTAR " R EV (t f )) 
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The subroutine has a built-in safeguard against inversion of a singular matrix when 
the transfer is 2 -dimensional. 

i). Internal Parameters 

Same as listed under LAMB. 
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Subroutine 

A. Input Paramete rs 


Parameter 

Symbol 

VST AH T 

t 

o 

TM- 

. V ' 

TEND 


RSVO 

vv 

VSVt 

V.VgvV 

V'SVO 

v sv~<V . 

RSEO 

^WV 

VSEO 

V SE <t o ) 

USMO 

R SM ( V 

VSMO 

^SM (t o ) 

KliRMIN 


lUNC 


knrsav 


TTERD 


1'1,’LMAX 


VSVMPD 

V SV (t m )( OLD 

RSVMD 

R SV (t m ) * OLD 

• RSVTAR 

r svtar 

VS V TAR 

"VSV TAR 

SU'D 

(t r* Wold 

S12D 

*\n (t P ^mVjLD 


COMF 

Definition 
Starting time 

Interior impulse .time 

Terminal time 


Allowable position error 

Number of increments in solving 
Lambert problem 

Lambert iteration parameter 

Outer loop iteration number 

Maximum number of Lambert iterations 

Target position 
Target velocity 
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B. Output Parameters 


KSVM 

Tr sv <t m ) 

+ 


VSVMP 

V sv <t m ) 


VS VMM 

■ w 


DV 

AV 


UVI 

*VI 


UVM 

U VM 


UVF 

^VF 


SMI 11 

SM112 

<P ( V ‘o’ 

State tr ansition matrix from t Q to 

SMI21 

SMI22 

V 

SFM11 

SFM12 

if> t ) 

State transition matrix from t m tc 

SFM21 

SFM22 

C . Computation 

~ i m 

V 


Step 1. Call FOURBY to advance states from t Q to t m . 


Step 2. 
Step 3. 


If ITERD i. 0, go to step 4. 


+ <t ) ^ ‘ +J 

SVX ' x m J 


Set V cifv <t_) = V gv (t m 


H SVX <t m > " R SV {t m ) 



Go to step 6. 


Step 4, Solve second leg Lambert problem In increments 


R SVX (t m ) * ' R SV (t m ) OLP 

V SVX +<t m ) “ V SV (t m } OLD 

dR m = (R SV (t m ) " R SV (t m ) OLD )/ ILINC 

Set <p u (t f , t m ) = <p u> OLD 

^12 (t f' t m ) C ^12, OLD 
ITEHL * 0 
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Step 5. 


Step 6. 

Step 7. 
Step B. 


Step 9. 


dV m = - W V"' ‘m* dR m 


R SVX U m ) = R SVX (t m ) * dR m 


V SVX +(t m ) = V 


SVX<W +dV m 


Call LAMB 

ITERL = ITERL +1 

If ITERL < ILINC, go to step 5. 

V SV +(t m ) = V SVX (t m ) 

AV m “ V SV +<t m ) “ V SV (t m ) 

AV f = V SVTAR " V SV <t f ) 
u VI = unit (AT q ) 

u VM - UNIT (AV m ) 
u VF = UNIT (AV f > 

AV = |AV o | + |AV\J + |AV f | 
EXIT 


80 



Subroutine 

COMES 

A. Input 

Parameters 


Parameters 

Symbol 

Definition 

T START 

..V. 


TM 

■■■■v 


tend 

tf 


REVO 

s'evV 


VEVOP 



VKVO 

^EV (t o ) 


REMO 

^EM ( V 


VEMO. 

V EM (t o ) 


ERItMlN 


Allowable position error 
Number of increments to solve 

ILINC 


Lambert problem .. 

KNRSAV 


Lambert iteration parameter 

ITERD 


Iteration number of outer loop 

ITLMAX 


Maximum Lambert iterations 

VEVMPD 

^EV (t m ) OLD 


HE’VMD 

V^ t m ) OLD 


REV TAR 

r evtar 


VEVTAR 

Tevtar 


S11D 

<p ll (t f > t m ) OLD 


S12D 

Q 

0 

Si 

•*-» 

rl 

a 
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B. Output Parameters 

REVM 


R EV <t m > 

VEVMP 


V EV V 

VEVMM 


t)V 


AV 

uvt 


n vt 

UVM 


U VM 

UVF 


U VF 

SMJ11 

. 


SM (12 

... 

* (t m' t o ) 

SMI 21 


SMI22 , 



SFMU 1 



SFM12 1 

• 

<P (t f , t m > 

SFM21 : 


SFM22. 



DVM . 


AV 

m 

C. 

Computation 


Step 1. 

Call THRBDY to advance states From 


Step 2. 

If CTERD t 0, go to step 4. 


Step 3. 

SetV EVX +(t m ) “ V EV +(t m ) 



■ WJ-V 4 ™’ 



Go to step 6. 


Step 4. 

Solve second leg Lambert problem 


R EVX <t m ) = R EV (t m ) OLD 

V EVX +(t m )= V EV (t m ) OLD 

dR M = (R EV (t m ) " R EV (t m ) OLD )/ ILtNC 


Set <P U (t f , t m ) = <P U ^ 0LD 

^12 ( V t m ) " ^12, OLD 
ITERL *= 0 
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Step 5, dV m - - (P l2 (t f , t m ) 1 (p n (t f# t m ) dR m 

R EVX (t m ) = R EVX (t m ) + dE m 

V EVX 'V = V EVX ( V + dV m 
Step 6.. Call LAMB3 


ITEHL - ITERL +1 

If ITERL < ILINC, go to step 5. 


Step 7. 

V KV +I 

V = V EVX + <V 

Step 8. 

11 

^EV V " V EV (t o> 


AV m 

= Y E v + V - v EV '(t m ) 


AV f « 

V EVTAR " V EV*V 


A 

< 

n 

unit (AV q ) 


U VM : 

= unit (AV^) 


Vvp = 

1 unit. (AV f ) 


AV • 

IAVJ + |AT M l + |AV f | 

Step 9. 

EXIT 
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Sub routine 


A, Input Parameters 

Parameters 

Symbol 

SMlll 

■VW * 0 ’ 

SMI12 

. «>12 (t m' * 0 * 

SMI21 

1>21 tt m- V 

SMI22 


SF.MX1 

9 u ft r * m ) 

SFM12 

®12 (t f ‘m’ 

SF.M21 

“WV t m ) 

SPM22 

<p 22 (t f Sn* 

II VI 

“VI 

UVM 

“VM 

UVF 

U VF 

VTMM . 


VTMP 

v + (t > 
m 

B. Output 

Parameter 

G 

1 

DU VI 

i <t 0 > 

DU VMM 


DUVMP 

t + (t m ) 


C. Computation 


COMG 

Definition 


Cost gradient g 



• ■' 

V<t m > * fmo, 21*VI + < Pmo. 22 X( V 
~* + <V * Vfm, 12 _1 <“VF ” V 11 U VM> 


3T 1 

= x m * ^VM 

£ C 

“ * S VM 

aav 

bV 

^mo, 12 (\n 

0 

&AV 

•SF~ 

= -i* • <v * 

m m 

m 

g 

= Y3AV T aAV^ 

^a? ’ St m 

0 m 


NOTE: In addition to the output parameters the following parameters are also 
printed out after each iteration. 

Parameter Symbol 

P VMM AG ^ tX m ’l 

PVPMAG ^ IV + I 




Subroutine PVEC 

A. Input Parameters 


Parameters 

Symbol 

Definition 

T 

t 


n 

R 


V 

V 


PVO 

?Vft 0 ) 


STM 

v (t, t Q ) 

State transition matrix 

IPVTM 


IPVTM = 0, Advance PV.only 
1, Also monitor max. 
value of primer vector magnitude. 

B. Output 

Parameters 

- \ 

PV 

PV(t) 

. pv(t) = d(t), X(t)) j 

LM 

Ixl 


1-4 DM 

W.w 


The following parameters are transmitted through COMMON/ CTM/ . 

TTM 


Time of maximum |x| 

RTM ' 



VTM 

V <‘m> 


L.TM 

Ix(t m )| 


LDTM 



PVTM 

* (t m> 

4- 


PVDTM 



KTNTM 

“"‘in'- ‘o* 

t ' = time when the primer vecto 
m 


magnitude if* maximum. 



c. 


Computation 



* ‘ptt* V 


\t <y / 


If IPVTM i 0, monitor |X (t) | to determine maximum value. 
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Subroutine DISP 

Both input and output parameters are transmitted through COMMON/ T DATA/ . 
A. Input Parameters 


Parameters 

Symbol 

Definition 

jisv 

If S < . 

. SV 

vsv 

V" s . 
■ . V sv - 

JiEV 


VEV 

v. 

RMV 

MV 

VMV 

V M 
V MV 

RSE 

V s - 

VSE 

. ^SE S 

RSM 

h sm 

VSM 


HE.'M 

T? |i: 

•EM 

VEM 

V E 
V EM 

B. Output Parameters 

RSL1 

R S 
pLl 

VSL1 

• V s 

SO 

liUV i) 

V" 

Position and velocity of vehicle 

V DV 1) 

'in” 

in D-frame 

ft DSI> 

IT l) 
K I)S 

VDSI-) 

V e D 
!)S 
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RDMD 

VDMD 

D 

r dm 

v" P- 
V DM 


RDL1D 

D 

R DL1 


VDL1D 

v D 

V DL1 


A NOV 

ANG v 

Angle at vehicle between LOS to 
sun and earth 

ANGE 

ANG E 

Angle at earth between LOS to 
sun and vehicle 

ANGS 

ANG S 

Angle at sun between LOS to 
vehicle and earth 

C. Computation 




The position and velocity of 4-body Lj point in S-frame are computed by 


R SU *' (1 " ^Ll* ( R SE + + R Em) 

~SL1 * (1 ’ ^Ll> ( V SE + u 11 Y Em) 

An earth centered rotating frame (D-frame) for display is used to suppress 
the motion of the earth which is significant due to its orbital eccentricity around 
the sun and the presence of the moon. 

Define: 

uX D S = unit 0?g E ) 
uZ D S = unit (R gE x V gE ) 

“V = “ Z D Sx “ X D S 

The transformation from the inertial S-frame to a frame parallel to the 
rotating D-frame is given by the matrix 

c s D ■ ((^d S ) T - (“ y d S ) T - (« z d S ) T ) 

The D-frame rotates with respect ot S-frame with an angular velocity 
defined by 
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.. -SI ) 8 = uZ 'd S ( W DS S * V Se) / I R SeI 

The trans formating from S-frame to D- frame for typical position and 

velocity vectors are as follows: 

' ' « S - TT 8 
W SD “ SE 

V SD S = V SE 

R D v D = c s D ^DV S = c s D (^sv S “ r sd ) 

V D v D = C S° (V " V SD S " W SD X *DV ) 

The angles at the vehicle, sun and earth are computed by 

ur sk - unit m SE ) 

™ EV - UNIT (? EV )' 
uB sv = UNIT (ff sv > 

ANG y » cos -1 CuR ev * uR gV )/DTR 
ANG e = cos’* 1 {-T3 R se • ■QR E y)/ DTR 
ANGg = 180 ~ (ANG V + ANG E > 

' DTR = Degree to radian conversion 



Subroutine DISP3 

Both input and output parameters are transmitted through COMMON/ TDATA3/. 


A. Input 

Parameters 

Parameters 

Symbol 

REV . 

TT e 

EV 

VEV 

v e 
EV 

KM V 

^MV 

VMV 

v m 

V MV 

REM 

'r e 
*EM 

VEM 

v* e 

V EM 


B. 

Output Parameters 

PEL 

* E L 6 

VKL 

■ E r 

JIDVD 


VDVD 

v ** 

V DV 

RDED 

^DE d 

VDED 


RDLD 

H D 

r dl 

VDLD 

V 1J 
V DL 

ANGV 

ANG y 

ANGE 

ANGp 

angm 

anc; m 


Definition 
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C, Computation 

The position and velocity of 3-body lib ration point L in e-frame are 
computed by 

R EL = a " R EM 

V EL = (l ‘ y) V EM 
where y > 0 for Lj and y < 0 for Lg. 

A moon centered rotating frame (d-frame) for display is used to suppress 
the motion of the moon. Define 


^XD * UNIT 


C^EM ) 


u ZD 6 = unit ( R EM 6 x V EM ) 

U YD 6 = X U XD 

The transformation from the inertial e-frame to a frame parallel to the 
rotating d-frame is given by the matrix 

c e d ■ ((*xn )* (*yd )* (*ZD e |) 

The d-frame rotates with respect to the e-frame with an angular velocity 

V e 


w. 


ec) 


u ZD e (u. 


EM 


YD 


1* 




EM 


The transformations from the e-frame to d-frame for typical position and 
velocity vectors are as follows: 


p ® = p ^ 

n ED EM 


V e = V, 6 
V ED 


EM 


R DV 


v cl 
I )V ■ 


C_ U Rrv,, 6 = C e d ( - R 


d 

e *‘DV 


e "r e 
EV ' n ED 


) 


<■;' (v EV e - w. - “ c ,. e * j, dv") 
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The angles at the vehicle, earth and moon are computed by: 
TO MV ■ UNIT(ff MV ) 

™EM = DNIT(R em ) 
uR ev = T)NIT(^ ev ) 

ANG y = cos " 1 <uR mv .’ uR ev )/DTR 
ANG m - cos " 1 (-uR em *. uR mV )/DTR 
ANG e = 180 - (ANG v +ANG m ) 

DTR = Degree to radian conversion 


93 



Subroutine PTRAJ 

Input parameters are transmitted through COMMON/ TDATA/, If 
i PTRAJ .» 1, the following parameters are printed at each time step. 

|rsv| |rev| 1pm v | 


T(DAY) 


H 


R 


SV 


■— ' F 

R EV 


% 


M 


MV 


v sv S 


V. 


E 


EV 

V M 
v MV 


^SE S 



V SE S 




V SM S 

R E 
n EM 



v em E 

p s 
*SU 



V&U 

R D 
W DV 



v D v D 

TV 1) 

r ds 



SJ D 
V DS 

■DM 
R D 
R DL1 



V D 
V DM 

D 

v 

V DL1 

ANG V 

ang e 

ANGg 

H(DAY) 

If IPV 

= 1, the primer vector history below is printed 

x 



X 

(xl 

-m ^ 










Subroutine PTRAJ3 

Input parameters are transmitted through COMMON/ TDATA3/, If 
IPTRAJ * 1, the following parameters are printed at each time step. 


R 


EV 


R 


m 


MV 

R ® 

. .EM 
«EL e 


TDAY 


H 


B(DAY) 


V 6 

V EV 

V m 

MV 


EM 
"v 6 

V EL 


|R 


ev 1 


Ir 


MV 


TT 


DV 


R 


DE 


V DV 

V DE* 


DL 

ANG 


Rrvr , V DL 

V ang e : ang m 

II' n»v - 1, the primer vector history is printed 


|x| a? M 







Sul.-? rout ine FDATA 


Input parameters are transmitted through COMMON/TDATA/ .. If IFILEX or 
IFILE is position nonzero the following double precision parameters are filed 
sequentially in unformatted form. 


Parameter 

File Location 

Parameter . 

File Location 

t 

+ 1 

“V D 
DS 

54-56 

li 

2 . 

D 

'em 

57-59 

*SV ’ 

3-5 


60 - 62 


6 - B 

*au 

63 - 65 

■^EV 

9 - 11 

v D 
V DU 

66 - 68 

V EV 

12-14 

X. X 

69 - 74 

r mv 

15 - 17 

W ; 

75 

V M V 

18-20 

»» 

76 

r se 

21 - 23 

ANG y 

77 

V SE 

24 - 26 

ANG e . 

78 

r sm 

27 - 29 

ANGe 

79 

"sm 

30 - 32 

Wsvl 

80 

r em 

33 - 35 

I^SV 1 

81 

V EM 

36-38 

l^ E vl 

82 

M SL1 

39 - 41 

l V E V I 

83 

V SL1 

42-44 

V 1 

84 


: 45 - 47 

^MV \ 

85 

v m° 

48 - 50 

Blank 

86 - 100 


51 - 53 

Total 

100 
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Subroutine FDATA3 

Input parameters are transmitted through COMMON/ TDATA3/. If IFILEX 
or IFILE is positive nonzero, the following double precision parameters are filed 
sequentially in unformatted form. 


Parameter 

File Location 

Parameter 

File Location 

t 

+ 1 

■7 d 

V DL 

42 - 44 

h 

2 

% 1 

45 - 50 

»1CV 

3-5 

lx! 

5i 

V EV 

6-8 


52 

r mv 

9-11 

ANG V 

53 

V MV 

' 12-14 

ANG e 

54 

k em 

15 - 17 

ang m 

55 

V EM 

.■ ' 18-20 

I r ev^ 

56 

R EL 

21 - 23 

• 1 V EV^ 

57 

V EL 

24-26 

I r M vI 

58 

Ti ,r 
M I)V 

27 - 29 


59 

V I)V 

30 - 32 


60 


33 -35 

1 v emI 

61 

"v* d 
V DE 

36 - 38 

Blank 

62 - 75 

R d 

r dl 

39 - 41 

Total 

75 
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TROUBLE SHOOTING 


In this section we list a number of common troubles, their causes and 

suggested corrective actions, 


Trouble 

Diagnosis 

Action 

Integration too slow; 

Allowable single step 
position error too small. 
Input error. 

Increase ERR MAX or 
ERRMXM, Check input. 

TWOBDY fails to 
converge or gives 
strange answers. 

Bad input state vector 
or gravitational constants. 

Check input. 

•POURBY (THI1BDY) 
gives strange answers. 

Bad input to TWOBDY. 

Check input. 

Slow to satisfy 
constraint. 

Allowable terminal error 
too small. 

Increase ERRMIN or 

E PST SI. | 

•1 

LAMB (LAMB3) fails 
to converge. 

Bad nominal trajectory. 

Search for new nominal 
closer to satisfy constraint. 
Reduce KNR. 

ETP21 (ETP213) fails 
to satisfy constraint. 

Bad nominal trajectory. 

Search for new nominal 
closer to satisfy constraint. 
Reduce KDX. 

ETP2I (ETP2I3) fails 
'to reduce AV. , 

Bad V- matrix. 

Reduce EPSV. Try new 
estimate of independent 
variables. ■ • 

PTP3I (PtP3T3) fails 
to reduce AV. 

Bad V- matrix. 

Reduce EPSV, Try new 
estimate of independent 
variables. 

Helpful Suggestions 



1. It pays to search for a nominal trajectory which comes close to satisfy ter minal 

constraint. This is not so important In a short transfer, which will converge 
even if the nominal trajectory misses the target badly. For long transfer, a 
bad nominal trajectory will prolong iterations due to increased nonlinearity, 
which reduces permissable changes in the independent variables. 
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2. A capability to plot trajectory Is very helpful to show whether a nominal 
trajectory U heading In the right direction. It is not difficult to adjust the 
Independent variables properly after examining a plot of the trajectory but 
it Is very difficult to determine what action to take by looking at a printout. 

3. It is generally better to run the programs by a succession of short runs 
instead of a single long run. The pauses between short runs enable the user 
to interpret the results and make necessary changes. It is not possible nor 
practical to fully automate a program to take into account all possible 
contingencies. 

4 . When a run is continued, use the current Independent variables, V-matrlx, 
KDX, KNR, etc. to maintain continuity. 
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5 EXAMPLE 1 

A. Purpose 

This example may be used. to check out Program TRAJ and associated sub 
routines. It is a 4-body transfer from noon July 4, 1978 from a 100 h. mi. earth 
parking orbit to Lj in 36 days. 

n. inp ut Parameters 


Card No. 

Format 

Parameter 

Value 

1 

4D20.11 

GL1 

1. 00109 8 D- 02 



AUM 

1. 49597893D+11 



UTIME 

5. 813235 7763 2D+01 



UVELM 

3. 35 742 40986 7D-05 

.. ‘ 2 

3 D20.ll 

MS 

9. 99996959568D-01 



/ ME ; 

3. 00348453188D-06 



MM 

1 3. 69431224671 D-08 

3 

415 

IMODE 

1 



1PV 

1 



IPTRAJ 

1 



IFILE 

o 

4 

4 D20.ll 

RSEO(l) 

1, 98930090999D-01 



(2) 

■-9,070505fl«ft501>01 



(3) 

6. 79027012471 D- 0 5 



VSE 0(1) 

9. 64906589348D-01 

5 

. 4D20.ll 

• (2) 

1. 92157060597D-01 



(3) 

-1. 47749626270D-05 


100 




RSMO (1) 

1. 99125783494D-01 


(2) 

-9. 94358817445D-01 

4D20. 11 

(3) 

-1. 68002571823D-04 


VSMO (1) 

9. 32348120275D-01 


(2) 

1. 950288 78 32 9D-01 


(3) 

-2. 62545160637D-04 

3 D20.ll 

TDAYO 

1, 099D+03 


TTRIPD 

3. 6D+01 


ERR MX M 

1. 524D+02 

4D20.11 

REVMAG 

4. 3873915 7152D-05 


VEVMAG 

3. 69220795569D-01 


OINCD 

2.85D+01 


OBLD 

2.34457874302D+01 

2 D20.ll 

LOND 

3.59181042981D+02 


THED 

-3. 51880454Q48D+01 

4D20. 11 

Ml) 

5 . 86468563221D-01 


(2) 

8. 06463656568D-01 


(3) 

7. 53060089751D-02 


Ml) 

-3. 43647891554D+03 

2D20.11 

(2) 

2. 4 7056 772 744 D-H) 3 


(3) 

3. 04177095939D+02 



c. Output Parameters 


A printout of the trajectory at each time step Is submitted with this guide in a 


separate package. The 

state vectors at the terminal time is 

RSV{1) 

7. 17957115972D-01 

(2) 

-7. 013428Q3746D-01 

(3) 

4. 27257573439D-05 

VSV<1) 

6. 79829811710D-01 

<2> 

7. 15967885505 D-01 

(3) 

-6. 21512 714224D-04 

The vehicle intercepts the 1^ point after 36 days. The trajectories with respect 
to earth and moon are shown in Figures 2a to 2f. The primer vector magnitude 
history is shown in Figure 2g. The AV of this transfer is 354. 57 m/s. Note 
that the initial earth parking orbit has an inclination of 28. 5 deg. If this 
restriction is removed, the AV of the same transfer of 36 dayB is about 288 m/s 

(Ref. 2). 
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T-flXIS 


0.012 


0.008 


0.004 


- 0.004 


- 0.008 


- 0 . 012 - 
- 0.012 









T-AXIS 


0.012 + 


0.008 + 


0.004 + 


04 


-0.004 


-0.008 


- 0.012 

- 0 , 


POSITION WRT MOON IN X-Y PLANE 

X - EARTH 
. * SPACECRAFT 
LAUNCH i NOON JULY 04 1978 
TRIP j 036 DAYS 


012 



>0.009 


-0.004 0 

X-AXIS 


0.004 


Figure 2b 2-Impulse Transfer (Example 1) 
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r-fixis 







SPACECRAFT DISTANCES 


0.013- 


0.012 + 


0.0U 


SPACECRAFT DISTANCES 
♦ - TO LI 
X - TO EARTH 
... 0 - TO MOON 
LAUNCH » MOON JULT, 04 1978 

Trip V 038 ' Wi ^ 


0.010 


0.009 + 


0.008 + 


0.007 + 


0.006 + 


0.00S + 


0.004 


0.003 + 


0.002 


0.001 



20 30 

TRIP TIME IDfiTl 


Figure 2e 2-Impulee Transfer (Example 1) 
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SPACECRAFT VELOCITIES 



— • 
SC 


Figure 2f 2-lmpulse Transfer (Example 1) 
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PRIME VECTOR MAGNITUDE 


PRIME VECTOR MAGNITUDE 
LAUNCH t NOON JULY 0U 1978 



Figure 2g 2 -Impulse Transfer (Example 1) 
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• EXAMPLE 2 

A. Purpose . 

This example may be used to check out Program EXLAM and associated 
subroutines. It is a 4-body transfer from noon July 4, 1978 from a given position 
at earth to a given point in space in 36 days. 

B. Input Parameters 

* Same as In Ex. 1 


Card No. 

Format 

Parameter 

Value 

1 

4 D20.ll 

GLl 

* 



AUM 

* 



UTIME 

* 



UVELM 

* 

2 

3 D20.ll 

MS 

* 



ME 

* . . • 



MM 

* 

3 

415 

IMODE 

2 



ITLMAX 

50 



IPTJX 

0 



IFILEX 

0 

4 

4D20.11 

RSEO (1) 

1. 98930091D-01 



(2) 

-9. 97050589850D-01 



(3) 

6. 79027012471 D-05 



VSEO (1) 

9. 64906589348D-01 

5 

4D20.U 

(2) 

1. 92157060597D-01 



(3) 

-1. 477496262 70D-05 


no 





RSMO(l) 

1. 991257834940-01 



(2) 

-9. 9435 8817445 D-i-Ol 

6 

4020.11 

(3) 

-1. 680025718230-04 



VSMOO) 

9. 323481202750-01 



(2) 

1. 950288783290-01 



(3) 

-2. 62545160637D-04 

7 

S D20.ll 

TDAY0 

1. 0990+03 



TRIPP 

3.60+01 



ERRMXM 

1. 524D+02 

8 

41)20.11 

RSVTAR 

7. 17957115972D-01 




-7.013428037400-01 




4. 272575734390-05 



ERR MIN 

1. 0D-10 

9 

1 D20.ll 

. KNR .. 

1. OD+OO 

10 

4 D20.ll 

REVO (1) 

3. 550987601490-05 



(2) 

-2. 568582517050-05 



(3) 

-2.051236432400-06 



VEV0PU) 

2.168333934690-01 

11 

21)20.11 

(2) 

2. 975577570820-01 



(3) 

2. 764693067270-02 


C, Output Parameters 

A printout of Lambert iterations is submitted with this guide in a separate 
package. The initial state vector is: 



RSVO (1) 

1. 98965600875D-01 . 

(2) 

-9. 97076275675D-01 

(3) 

6. 58514648147D-05 

VSVI(l) 

1. 18173998282 D+00 

(2) 

4. 8 9 7148176 79 D- 01 

(3) 

2. 7632155 7101D-02 

iteration history is as follows: 

ITER 

Error (|i/) |) 

\ - 

3.9725 1 >-05 Initial r 

2 

1. 63 4 9 D- 04 

3 

3. 4139D-05 

4 

2. 0172D-05 

5 

1. 7986D-05 

6 

1. 6351D-05 

7 

9. 6429D-09 

8 

0. 1105D-12 < ERRMIN 

■ converged solution is 

VSVI(l) 

1. 18164961297D+00 

(2) 

4. 89491098961D-01 

(3) • . 

3. 06148929077D-02 
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EXAMPLE 3 

A. Purpose 

This example may be used to check out Program ETP2I and associated 
subroutines. It is a 4-body transfer from noon July 4, 1978 to Lj in 44 days. The 
earth parking orbit has an inclination of 28. 5 deg. 

B. Output Parameters 

* Same as in Ex. 1 
** Same as in Ex. 2 


Card No. 

Format 

Parameter 

Value 

1 

4D20.11 

GL1 

* 



AUM 

jjc 



UTIME 

* 



UVELM 

* 

2 

3 D20.ll 

MS 

* 



ME 

* . 



MM 

* 

3 

4 D20.ll 

REVMAG 

* 



OINCD 

* 



OBLD 

* 



ERRMXM 

* 

4 

2 D20.ll 

TDAYO 

* 



TTRIPD 

4.40D+01 

5 

3 D20.ll 

VEVMAG 

3. 69195 894918 D-01 



LOND 

3.40D+02 



THED 

0. D+00 
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4D20.11 

RSEO^(l) 

* 


(2) 

* 


(3) 

* 


VSEO (1) 

* 

41)20.11 

(2) 

* 


(3) 

>!< 


RSMO(l) 

* 


( 2 ) 

* 

4D20.11 

(3) 



VSMO(l). 

* 


(2) 

* 


(3) 

* 

41)20.11 

EPS . 

1 . OD-11 


EPSTSI 

liOD-10 


KDX 

1 . OD+OO 


EPSV 

1.0D-03 

14 

1C0MV 

1 


. ITERMX 

50 


IFILEX 

0 


ITAR 

0 

3D20.11 

AYM 

0 


AZM 

0 


ATARD 


0 



C. Output Parameters 

The state vector at the terminal time is: 


RSV{1) 

8.04147100281D-01 

(2) 

-5. 98272665021D=0l 

<3) 

3.54443603861D-05 

VSV(l) 

5. 80 8 86 32 006 ID- 01 

(2) 

8. 02081814322 D-01 

(3) 

-4. 4380 991013 7D-04 

converged initial conditions are: 

VEVMAG 

10997.18 m/s 

LOND 

358. 32 deg 

THED 

-23.43 deg 

costs are.* 

o 

> 

3204.20 m/s 

|AV f l 

377. 80 m/s 

3582.00 


Ref. 2 indicates that |AV f | is 263. 31 m/s for the 44 day transfer without 
the inclination angle costraint. 

A printout of the iterations together with the trajectory at each time step 
is submitted in a separate package. 

The trajectory Is shown in Figure 3a to 3f. The primer vector history is 
shown in Figure 3g. 
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Figure 3d 2-Impulse Transfer (Example 3) 
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PRIMER VECTOR MAGNITUDE 
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Figure 3g 2 -Impulse Transfer (Example 3) 
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•EXAMPLE 4 

A. Purpose 

This example may be used to check out Program PTP3I and associated 
subroutines. It is a 4-body 3 -impulse transfer from noon July 4, 1978 to Lj in 
44-days. The 2-impulse transfer shown in Ex. 3 was used as the reference. 

B. Input Parameters 

* Same as in Ex. 1. 

The starting independent variables (v o , t^) shown here are values near 
the end of a sequence of computer runs. 


Card No. 

Format 

Parameter 

Value 

1 

4ID20.il 

GL1 

* 



AUM . 

>',c 



UTIME 

. * 



UVELM 

* 

2 

3 D20.ll 

MS 

* 



ME 

* 



MM . 

* 

3 

3 D20.ll 

TSTART 

1. 89051337719D+01 



TM 

1. 96108629221D4O1 



TEND 

1. 966202 72 076 D+01 

4 

4D20. 11 

RSEO(l) 




(2) 

* 



(3) 

* 



VSEOU) 

* 

5 

4D20.11 

(2) 

* 



(3) 

* 
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RSM0(1) 



. (2) 

❖ ; 

41)20.11 

(3) 

* 


VSMO(l) 

* 


(2) 



(3) 

* 

4 D20.ll 

RSVO(l) 

1. 98969880525D-01 


(2) 

-9. 970690443 01D-O1 


<3) 

6. 68331499258D-05 


VSV0{1) 

1.07508453453D+00 

2 D20.ll 

(2) 

4, 28411625788D-01 


(3) 

2. 23856828208D-02 

4 D20.ll 

VSVI(l) 

1, 12559555237D+00 


(2) 

5, 23005315320D-01 


(3) 

3. 22363348080D-02 


VSVMP(l) 

6.12270768134D-01 

2 D20.ll 

(2) 

7. 70222061894D-01 


(3) 

-3.40U0040616D-04 

4 D20.ll 

RSVTAR(l) 

8. 04147100222 D- 01 


(2) 

-5. 98272665036 D-01 


(3) 

3. 54443659015D-05 


VSVTAW1) 

5. 74883737675 D-01 

2D20.il 

(2) 

7. 90914481955 D-01 


(3) 

-5. 54211553533D-05 



3 D20.ll 

KNR 

1. 0D+00 


ERRMIN 

1.0D-10 


errmxm 

1. 524D+02 

3D20.11 

FMINM 

3. 4D+03 


EPS 

1. 0D-02 


EPSV 

1. 0D-04 

15 

ICOMV 

0 


itlmax 

100 


TLINC 

2 


ITDMAX 

100 


1FILEX 

0 

41)20.11 

va, i> 

1. f> 0 70 4407134 D- 04 


V(l, 2) 

1. 0812 7195 7 36 D-0 4 


va, 3) 

-1. 885 2 7012972 D-03 


VU, 4) 

-1. 33164676422D-01 

4 D20.ll 

V(2, 1) = 

V(l. 2) 


V{2, 2) 

-1. 72891113995 D-04 


V{2. 3) 

1. 25136470933 D-03 


V(2, 4) 

1. 001195 85112D-01 

4 D20.ll 

V(3, 1) = 

V(l, 3) 


V(3, 2) = 

V(2, 3) 


V<3, 3) 

-3. 48 82 440100 9 D-03 


V(3. 4) 

-3. 68585896226D-01 
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4D20.U 


V(4, 1) = V{1, 4) 

V(4, 2) * V(2, 4) 

V(4, 3) = V(3, 4) 

y( 4| 4 ) -3. 324013 3556 6 D401 


C. O utput Parameter a 

The trajectory is shown tn Figure 4a to 4f. The primer vector history is 
shown tn Figure 4g. The interior impulse applied at about 41. 9 days is nearly at 
the end of the 44 -day transfer. The costs are 


Initial impulse 
Interior impulse 
Terminal impulse 


3207. 35 m/s 

273.44 m/s 

97. 64 
35 78. 43 


The 3 -Impulse transfer costs about 3.50 m/s less than the 2-Impulse 
transfer. 


I). 


Comment 


The 3-impulse transfer is difficult to generate, especially when the 
2-impulse transfer Is nearly optimal. First, the difficulty is to break away 
from the 2 -impulse transfer. Secondly, the cost gradient must be reduced 
several orders of magnitude lower than necessary In order to satisfy the 
condition 

* *m W \n 

while the cost remains practically unchanged. To accomplish this it may be 
necessary to reduce the single step allowable position error by an order of 

magnitude. 
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PRIMER VECTOR MACHJTUOE 


PRIMER VECTOR MAGNITUDE 
2.10 LAUNCH i NOON JULY 04 1378 

TRIP : 044 DATS 
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PROGRAM AND SUBROUTINE LISTING 


TRAJ 

TRAJ3 

EXLAM 

EXLAM3 

ETP2I 

ETP2I3 

PTP3I 

PTP3I3 

FOUR BY 

THRBDY 

twobdy 

CSTEP 

CSTEP3 

DELRV 

DELRV3 

COMIC 

COMIC3 

COMFG 

COMFG3 

COMF 

COMF3 

COMG 

CTAR 


LAMB 

LAMB3 

DISP 

DISP3 

PTRAJ 

PTRAJ3 

PDATA 

FDATA3 

COMAUG 

COMDX 

UPX 

PVEC 

RVEMV . 

MXV 

VVT 

DOT 

VMAG 

INVERT 

UNITV 

VXV- 

M TRANS 

MXM 
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PROGRAM TRAJ 

PROGRAM PROPAGATES GIVEN 
IMPLICIT REAL*8I A-H,L-M,0-Z ) 


STATES FROM T START TO TEND 



READI5, 100)MS,ME,MM 
READ! 5,101) IMOOE t IPV,IPTRAJ» IFILE 
READ! 5, 100 )RSEO, VSEO, RSMO, VSMO 
READl 5,10© >TDAYO,TR I PD, ERRMXM 
DTR= 1.74532925199432960-2 


ERRMAX=ERRMXM/AUM 
TDAYMTDA YO+TR I PD 
TSTART=TDAYO/UTIME 


TEND=TDAYF/UT IM6 
IMTX»0 
I PVTM=0 

WRITE?©, 1 02 )GL 1, AUM,UT 1ME ,UVELM, ERRMXM, ERR MAX , MS, ME , MM 
WRITE (6, 103)T0AY0,TR1P0,TDAYF,TSTART,TEN0 
WRITE(6,105)RSE0,VSE0, RSMO * VSMO 
GO T0( 1,2,3) ,1 MODE ^ . . ph 

1 RE AD(5, 100)REVMAG,VEVMAG,OINCD,OBLD,LOND,THED 
0INC-DTR*0 I NCD 

OBL=DTR*OBLD 

LON*DTR*LOND 

THE=DTR*THED 

CALL COM IC ( REVMAG,VEVMAG , LON ,TH6 ,OINC ,08L ,RS€0, VSEO, 
1REV0, VEVO,RS.VO, VSVO, VSVI ) 

WR I TE ( 6, 106 ) REVMAG, VEVMAG fOINCDfOBLD, LOND,THED 

GO TO 6 

2 READ! 5,100)REV0,VEV0P 
DO 201 1 = 1,3 

RSVO ( I )*RSEO( I I + REVOU ) 

201 vsvi m=vsEom+vevop( n 

WR I TE ( 6,107)REVO,VEVOP 


GO TO 6 

3 READ(5,100)RSV0,VSVI 

6 WR1TE(6,108)RSV0,VSVI 
I F ( IPV.EQ.O) GO TO 7 
RE AD ( 5 , 100 ) PVO 
IMTX=1 

I PVTM= 1 

WRITE<6,109)PV0 

7 WRITE! 6, 104) IMOOE, I PT R A J , I F I LE , I MTX , I PV , I PVTM 

CALL FOURBY(TSTART,TEND, RSVO, VSVI ,RSEO, VSEO, RSMO, VSMO* 

1PV0, RSVF * VSVF , RSEF , VSEF , RSMF , VSMF , $ 1 1 , $ 1 2* $21 , S22 ) 

WRITE(6, 110)RSVF,VSVF,RSEF,VSEF,RSMF,VSMF 

100 FORMAT ( 4D20. 11) 

W? FORMAT t^H ,40X, 'FOUR-BODY TRA JECTORY • / 1H0,T8 , • GL1 • , T28 , • AUM • 
1T48, 'UTIHE' ,T68, 'UVELM* ,T88 ,' ERRMXM* ,T 108 , ' ERRMAX * / 1H , 
21P6D20.11/1H »T8, •MS* ,T28, »ME 1 ,T48, 'MM* /1H , 1P3D20.11) 

103 FORMAT ( 1H0,T8, • TOAYO* ,T28, , TRIPD* ,T48 , * TDAYF • , T68 , • T START • , 


, 



1T88i 1 TEND • /1H ylP5020«ll) too 

104 FORMAT ( 1H0*T8* • I MODE 1 ,T28 t * IPTRAJ* »T48» • IFI LE* »T68 » • IMTX* f T88t 

1‘1PVST108,»IPVTM*/1H ,110,5120) ^ - 

5 FORMAT ( 1H0»T8» • RSEO* »T68 f •VSEOVIH , 1P6D20 . 1 1 /1H f T8,*RSM0 » 

* 1T68, # VSM0*/1H , 1P6D20.11) 

106 FORMATS 1H0*T8, »REVMAG* tT28 f •VEVMAG' »TA8t •OINCD 1 ,T68 ♦ OBLO » 

1 T88 » 9 LOND 1 *1108* • THED 1 / 1 H , 1P6D20.11) 

107 FORMAT ( 1H0* T8f *REVO 1 tT6 8» • VEVOP 1 /1H tlP6D20.ll) 

108 FORMAT* 1H0 » 7 6 * • RSVO 1 t T6B t ’ V $V I • / 1H , 1P6D20.11) 

109 FORMAT ( 1H0? T8t • PVO* /1H tlP6D20.ll) rtrcc4 

110 FORMAT! 1M0,T8,»RSVF« , T68 , 1 V SVF ' / 1H t 1P6D20 . 1 1 / 1H »T8t RSEF 9 

1 T68 * * VSEF 1 / 1H tlP6D20.il/lH t T8 » * R SMF •» T68 * ■ V$MF ' / 1H ,1P6020#1 
RETURN 
END 


'RSEF 
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C PROGRAM TRAJ3 

PROGRAM PROPAGATES GIVEN STATES FROM TSTART TO TEND IN 
EARTH-MOON-VEHI CLE SPACE . 

IMPLICIT REAL*8(A-H,L-M>,0-Z) 

DIMENSION REMO(3) ,VEMO(3) ,REVO(3) , VEVO( 3 ) , VEVOP ( 3) ,REVF<3> , 

1VE VF { 3 ) ,REMF ( 3 ) ,VEMF ( 3 ) »S11 (3,3),S12(3,3),S21(3,3)»S22(3*3) 
COMMON/FLAG/IMTXt IPV, IPTRAJf IPVTM t IFILE t ITER 
CQMMON/CONST3/ME, MM, GAMMA, UDM,UTIME,UVELM,ERRMAX,DTR 
READ( 5,100) GAMMA ,UDM ,UT IME ,UVELM 
READ( 5, 100)ME,MM 

READ( 5,101) IM0DE,IPV,IPTRAJ,1FILE 
RE AD( 5, 100 ) REMO* VEMO 
READ! 5,100)TDAY0,TRIPD,ERRMXM 
DTRa 1 * 74532925 19943296D- 2 
ERRMAX=ERRMXM/UDM 
TDAYF=TDAYO+TR 1 PD 
TSTART=TDAYO/UTIME 
TEND=TDAYF/UT IME 
I MTX=0 
I PVTM=0 
I TER=0 

WR ITE( 6, 102 ) GAMMA, UDM,UT IME, UVELM, ERRMXM, ERRMAX , ME »MM 
WRITE( 6,103 )TDAYO»TR I PD,TDAYF, TSTART, TEND 
WRITE(6,105 ) REMO, VEMO 
GO TO (1,2), IMODE 

1 READ(5,100)REVMAG, VEVMAG, OINCD,LOND,THED 
OINC»DTR*OINCD 
L0N=DTR*L0ND 
THE=DTR*THED 

i CALL C0MIC3( REVMAG, VEVMAG, LON, THE, OINC, REVO, VEVO, VEVOP I 
WRITE! 6, 106)REVMAG, VEVMAG ,OINCO,LOND,THED 
GO TO 3 

2 READ(5,100)REV0, VEVOP 

3 WRITE(6,107) REVO, VEVOP 
IF(IPV.EQ.O) GO TO 4 
RE AD( 5,100) PVO 
I MTX*1 
I PVTM= 1 

WRITE(6,108)PV0 

4 WRITE(6, 104) IMOOE, IPTRAJ, IFILE, 1MTX, IPVtlPVTM 
CALL THRBDY( TSTART, TEND, REVO, VEVOP, REMO, VEMO, PVO ,REVF,VEVF, 

1REMF, VEMF , SI 1, S12, S21 , S22 ) 

WR1TE( 6,109)REVF,VEVF,REMF,VEMF 

100 FORMAT ( 4D20. 1 1 ) 

101 FORMAT (415) 

102 FORMAT ( 1H , 40X , • THREE-BODY TRAJECTORY •/ 1H0,T8 , 4 GAMMA • ,T28, 

1 * UDM , ,T48, , UTIME* ,T68,* UVELM* , T88 , * ERRMXM • , T 108 , * ERRMAX * / 1H , 
21P6D20.11/1H ,T8, * ME * , T28, •MM* / 1H , 1P2D20.11) 

103 FORMAT* 1H0,T 8, *TDAYO* ,T28,*TRIPD* ,T48 , * TDAYF • , T68 , * T START 1 , 
1T88, • TEND* / 1H ,lP5D20*i'l) 

104 FORMAT ( 1HG,T8, * IMODE • ,T28, • IPTRAJ* ,T48 , « I F I L€ * ,T68 , 1 IMTX* , 

IT 8 8,* IPV* ,T108, • 1PVTM* / 1H ,110,5120) 

105 FORMAT ( 1H0,T8, 1 REMO* ,T68, • VEMO* /1H ,1P6D20.11I 

106 FORMAT ( 1H0,T8, 1 REVMAG* ,T28 , • VEVMAG* ,T48» 'OINCD* , T68, •LOND*, 

. 1 T 88, * THED * / 1 H , 1P5D20.11) 

107 FOR MATT 1H0,T8, ‘REVO* ,T68, • VEVOP* /1H , 1P6020.11) 

108 FORMAT(1HO,T8,*PVO'/1H ,1P6D20.11> 
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109 FORMAT ( IHOt T8* «REVF> » T 68 , » VEVF«71H * 1P6D20. i l/lH0,T8 t ‘REMF • t 
1 T 68 1 1 VEMF • /1H , 1P6D20.11 ) 

RETURN 

END 
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C 


PROGRAM EXLAM 

PROGRAM SOLVES 2-POINT BOUNDARY VALUE PROBLEM OF TRANSFER FROM 
A GIVEN INITIAL POSITION TO A GIVEN FINAL POSITION IN FIXED TIME. 
IMPLICIT REAL* 8 ( A-H, K-M, O-Z J 

DIMENSION RSEO!3),VSEO<3) ,RSM0(3) ,V$M0(3) ,REVO(3) ,VEVO(3) * 

1 RSVO! 3 ) ,VSVOt 3 ) ,VSVI ( 3 ) t VEVOP ( 3 ) »RSVF { 3 ) ?VSVF! 3 ) ,RSEF ( 3 ) * 

2VSEF(3),RSMF(3) ,V$MF<3) , SI 1 ( 3, 3 ) , S12 ( 3 ,3 > , $2 1 ( 3 ,3> ,S22(3,3) , 
3RSVTAR! 3) ,PV0<6) 

COMMON/CONST /M S t ME »MM,GL 1 »AUM,UT I ME f UVELM,ERRMAX ,DTR 
COMMON/FLAG/ IMTXf I PV, JPTRAJ, IPVTM, I F I L E , I TER , I T AR 
READ(5,100)GL1,AUM,UTIME,UVELM 
READ! 5, 100)MS,ME,MM 

READ(5 ? 101)IM0DE,ITLMAX,IPTJX,IFILEX 

READ! 5, 100)RS60,VSEO» RSMO* VSMO 

READ! 5,100)TDAY0,TRIPD, ERRMXM 

READ! 5* 100 )RSVTAR, ERRMIN 

READ! 5,100>KNR 

DTR=1.74532925l9943296D-2 

ERRMAX=ERRMXM/AUM 

TDAYF=TDA YO+TR I PO 

TSTARTkTDA YO/UT IME 

TEND=T0AYF/UT1ME 

IMTX=1 

IPV=0 , 

I PVTM=0 

I PTRA J = 0 j 

I F IL E = 0 

WRITE! 6, 102 ) GL1 AUM,UTIME,UVELM, ERRMXM, ERRMAX, MS ,ME, MM, ERRMIN, 
1KNR 

WRITE (6, 103) TDAYO,TR IPO » TOAYF* TST ART , TEND 

WR 1 TE ! 6 * 104 ) I MODE , I TLMAX, IPTJX » I F I LEX , IPTRAJ, IFILE 

WRITE!6,105)RSE0,VSE0,RSM0,VSM0,RSVTAR 

GO TO (1,2,3), IMODE 

1 READ! 5,100 ) REVMAG, VEVMAG,0 INCO,OBLO, LOND» THED 
0 1 NC = D TR *0 1 NCD 

0BL=DTR*0BL0 

LON=DTR*LOND 

THE=DTR*THED 

CALL COMIC! REVMAG ,VEVMAG , LON ,THE ,OINC ,OBL , VC I R ,RSEO , VSEO , 

1 RE VO, VE VO, RSVO, VSVO, VSV I ) 

WRITE! 6, 106) REVMAG, VEVMAGfO I NCD fOBLOtLOND,THED 
GO TO 6 

2 READ! 5 T 10O)REV0,VEV0P 
DO 201 1=1,3 

RSVOU ) = RSEO( I)+REVO( 1 ) 

201 vsvim=vsEO(n+vEvoP(i) 

WRITE(6,107)REVO,VEVOP 


3 

6 


ro 6 

)( 5, 100) RSVO, VSV I 
IE! 6, 108 )RSVO,VSVI 

L AMB ! T ST ART , TEND , R SVO , VSV I ,RS60, VSEO, RSMO, VSMO ,KNR , ITLMAX 
N * RS VT AR , RSVF , VSVF , R SEF , V SE F , R SMF , VSMF ,S11,S12,S21, S22 ) 


I PTRA J= I PT J X 
! FILE* I FI LEX 


IMTX=0 

IF! IPTRAJ. GT.O) GO TO 7 
IF! IFILE. GT.O) GO TO 7 


f 
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GO TO 8 

7 CALL FOURBY(TSTART,TENOfRSVO,VSVi,RSEO,VSEO,RSMO*V$MOfPVO, 

1R$VF,V$VF,RSEF,VSEF,R$MF,VSMF, S 1 1 , $ 1 2 » S2 1 , S22 > 

8 CONTINUE 

TOO F0RMATUD20.il) 

i 02 FORMATUH^UOX, • FOUR-BODY LAMBERT PROBLEM* /1H0,T8, »GLJ * tT28 , 
1 * AUM * , T48, 'UT I ME * ,T68, »UVELM» , T88 , • ERRMXM' * T 108 , ERRMAX /1H 
21P6020. 11 / 1 H ,T8,*MS, *,T28, 'ME' ,T48, • MM 1 , T68 , • ERRMI N » , T 88 , 

3 1 KNR 1 / 1H , 1P5D20.11) r 1T(T , OTI 

103 FDRMA'HlH0,T8,'TDAY0*,T28,«TRlP0*,T48, t TDAYF',T68, TSTART , 

1T88 , ' TEND ' / 1H ,1P5D20.11> .tct.cv# 

104 FORMAT! 1H , T 8 , * IMOOE * * T28 , * I TLMAX • , T48 , • I PT JX , T68 , I F I LEX ♦ 

1T88? 1 I PTRAJ ' tT 108* * IFILE* /1H ,110,5120) ^ _o .bcMm 

105 FORMAT! 1H0,T8, 'RSEO' ,T68, »VSE0»/1H , 1P6D20. 1 1/1H * J 8 * * SM0 * 
1T68, » VSMO' /1H , 1P6D20.11/1H ,T8 , ' RSVTAR ' /1H tlP3020.ll) 

106 FORMAT! 1H0,T8, ' REVMAG* »T28, 'VEVMAG' ,T48, 'OINCD' ,T68, OBLO , 

1 T88, 1 LONG • , T 108 , * THED ' / 1H , 1P6D20.11) 

107 FORMAT! 1H0,T8, 'REVO* ,T68, 'VEVOP'/IH , 1P6020.U ) 

108 FORMAT! 1H0,T8, 'RSVO' ,T6 8 , ♦ VSV I • / 1H ,1P6020.11) 


RETURN 

END 
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n no 


PROGR AM E XL AM' 3 

PROGRAM SOLVES 2-POINT BOUNDARY VALUE PROBLEM OF TRANSFER FROM 
A GIVEN INITIAL POSITION TO A GIVEN FINAL POSITION IN FIXED 
TIME* 

n « i a i 4 Li i > u r\ *r \ 


TIME* 

IMPLICIT REAL* 8 ( A-H»K-M»0-Z > 

DIMENSION REMO( 3 ) » VEMO< 3 > »REVTAR ( 3 ) »REVO( 3 ) »VEVO( 3 
IREVF ( 3 ) , VEVF < 3 ) »REMF ( 3 ) » VEMF (3)*Sll(3t3)tS12(3*3)f 
2S22( 3 » 3 ) r PVO( 6) ' • w H 


!S22( 3 * 3 ) t PVO< 6) 

COMMON /CONST 3 /ME , MM f GAMMA * UDM f UT I ME »UVE LM t ERRMAX r DTR 
COMMON/ FLAG/ IMTX* I PV, IPTRAJ, I PVTM ♦ I F I LE , I TER 1 1 T AR 
READ! 5,100)GAMMA»UDM»UTIME t UVELM 

RE AD ( 5 » 10 0 ) ME » MM 

READ( 5 ? 101) IMODE, ITLMAXt IPTJXt IFI LEX 

READ! 5 f lOOlREMOtVEMO 
READ! 5f 100)TDAY0»TRIPDt ERRMXM 
RE AD ( 5 » lOOIREVTARf ERRM IN 
READ! 5 » 1 00 ) KNR 
DTR= 1.745 3 292 51 99432960-2 
ERRMAX=ERRMXM/UDM 
TDAYF = TDAYO+TR 1 PD 
TSTART=TDAYO/UTIME 
TEND=TDAYF/UT IME 
I MT X = 1 
IPV = 0 
I PVTM=0 
IFILE=0 

WRITE t 6 f 102 ) GAMMA tUDMt UTIME ♦ UV ELM ♦ ERRMXM t ERRMAX t ME *MM i 

WRITE(6 f 103)TDAY0f TR I PD» TDAYF t T START , TEND 

WR I TE ( 6t 104 ) I MODE » ITLMAX? IPTJXtIFILEX 

WRITEI6, 105) REMO tVEM0*R6VTAR 

GO TO ( 1 ? 2 ) » IMODE ^ 

1 READ<5, 100)REVMAG,VEVMAG,0INCD,L0NDtTHED 
OINC-DTR*OINCD 
L0N=DTR*LGND 
TME=DTR*THED 

CALL COM'i C 3 C REVMAGt VE VMAGt LON f THE »OINCf REVO »VEVO*VEVOP 
WRITE (6 f 106)REVMAG»VEVMAGT0INCDtL0ND,THED 
GO TO 3 

** READ ( 5 » 1O0 ) REVO t VEVOP 
WR I TE ( 6 * 107 ) REVO f VEVO P 

v * nuollTCTLOT.TC 


3), VEVOP (3), 
S2 1 ( 3 1 3 ) ♦ 


ERRMIN »KNR 


WRITE(6»107)REV0, VEVOP 

CALL LAMB3ITST ART t TENO, REVO ♦ VEVOP tREMOtVEMOt 
REVTAR» REVF* VEVF * REMF * VEMF * SI 1 1 $12* S21* S22 ) 
WRITE ( 6* 108 ) REVF tVEVF fREMF>VEMF 
I PTRA J= I PT JX 


KNR* ITLMAX *ERRMIN* 


1REVT 

E ( 6 • _ 

iPTjX 
IFILE=IFILEX 
IMTX=0 

IFUPTRAJ.EQ.ti) GO TO 4 
IF C IFIlE.EO.O) GO TO 4 
GO TO 5 


in iriLL.i-wiui v-’i-' 

4 C All^THRBDYl TST ART, TEND, REVO, VEVOP, REMO, VEMO,PVO, REVF, VEVF, 

1REMF,VEMF,SU,S12,S21,S22) 

5 CONTINUE 

00 FORMAT 14D20. 1 1 ) 

01 FORMAT (415) 

02 FORMATdH 
1 »UDM 
21P6D20 


INUE 

ATI4D20.11) 

IAT (415) 

AT ( 1 H * 40X * * 3— BODY LAMBERT PROBLEM •/ 1H0 * T8 *• GAMMA 1 * T 28 * 

!• t T48* *UTIME ' * T68* • UVELM * *T88* • ERRMXM* , T108 * * ERRMAX '/ 1H * 
i 20.11/1H *T8 * • ME ♦ tT28t*MM l * T48 * ‘ERRMIN* *T68 * 1 KNR • / 1H * 
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3 iP 4 D 2 o.m 

103 FORMAT ( 1 H 0 ,TB» » TDAYO 1 9 T 28 » * TR I PD ' *TA 8 t •TDAYF* 9 T68 9 * TSTART ' 9 
IT889 * TEND* / 1 H , 1 P 5 D 20 . 11 ) . 

p 4 FORMAT ( 1 H , T8 9 ' I MODE ' 9 T 28 , • I TLMAX 1 .T 48 9 ' I PT JX * 9 T68 9 ' I F I LEX / 

105 FORMAT^lHO 9T8 9 'REMO* 9T689 1 VEMO' /lH ♦ 1P6D20 . 1 1 / 1H 9T8 9 1 REVTAR 1 / 
11H , 1P3D20.H) 

106 F0RMATaH0tT8 t 1 REVMAG* f T28, • VEVMAG* 9T489 ’OINCD* 9T689 'THED / 1 H 9 


11P4D20.11 ) 

107 FORMATi IHO 9 T 89 ‘REVO* 9 T 68 , •VEVOP'/IM 9 lP 6 D 2 O.ll) 

108 FORMATS IHO 9 T 89 * REVF ' 9 T 689 1 VEVF 1 /1H 9 1P6D20. 1 1 / 1H 9 T 8 1 1 REMF 9 
1T68, * VEMF 1 / 1H t lP6D20.11) 

RETURN 

END 
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19 


PROGRAM ETP2I 

PROGRAM COMPUTES FUEL OPTIMAL 2-IMPULSE TRANSFER FROM A PARKING 
ORBIT OF GIVEN INCLINATION TO A GIVEN FINAL POSITION AND VELOCITY 
IN FIXED TIME. 

IMPLICIT REAL* 8 ( A-H , K-M ,Q-Z ) 

DIMENSION RSEO(3),VSEO<3)*RSMO<3),VSMO(3j,XD<3),X<3),XS<3), 
1RSVTAR ( 3 ) fVSVTARI 3) t VI 3*3) tGSI 3>*T$IS(3) »LTS(3»3> t LS!3t3l * 

2SliS{3,3),S12SI3*3),S21S<3,3),S22S<3,3),GGS(3),VSAV{3,3)*G<3) , 

3TSI(3> ,LT(3,3) ,L(3,3) ,GG(3) ,S11(3*3) , S 1 2 ( 3 * 3 ) , S21 { 3 , 3 ) * 
4S22<3,3),DX(3),0ELX<3) ,UVI ( 3 ) f UVF { 3 ) , TEMP ( 3»3 ) * DUM ( 3 ) jUVID i 3 ) 
DIMENSION R t 3 ) , RMVO l 3 ) ,VMVO( 3) ,RSVO( 3) , VSVI ( 3 ) *UVI S ( 3 ) ,UVFS(3) , 

1GOI3) ,TS 10(3 ),LTDt 3,3), LO( 3,3) ,51101 3*3 )*S12D( 3,3 ),S2 10(3*3) , 

2S22D( 3 ,3 ) , RSVF (3 ) tVSVF (3)*RSEF(3)*VSEF(3) *RSMF < 3) *VSMF ( 3) * 

3 DUVI ( 3 ) , REVO< 3 ) *VEVO( 3 ) *UVFD( 3 ) * PVO ( 6 ) *GGD( 3 ) *VSV 0 { 3 ) 

COMMON/FLAG/ IMTX* IPV * IPTRAJ r IP VTM* I F I LE * 1 TER » 1TAR 

COMMON/CON$T/MS*ME*MM*GLl*AUM,UTIME*UVELM,ERRMAX*DTR 

COMMON/ TARG /AY , AZ * ATAR * RSVTAR *VSVT AR 
READ! 5, 100)GL1» AUM*UT IME *UVELM 
READ(5*100)MS*ME,MM 

READ( 5* 100)REVMAG,OINCD*OBLD*ERRMXM 
READ! 5,100)TDAYO*TTRIPD 
READ! 5, lOOIVEVMAG* LONO*THED 
READ( 5,100)RSE0*VSE0*RSM0,VSM0 
READ! 5, 100IEPS,EPSTSItKDX,EPSV 
READ( 5,101 ) ICOMV, ITERMX, IFILEX ,ITAR 
1 F ( 1TAR.GT.0) GO TO 21 
REAO( 5 ,100) AYM,AZM, ATARD 
GO TO 22 

READ! 5, 100) RSVTAR, VSVTAR 
I F. ( ICOMV.GT.O) GO TO 19 

OPTION TO INPUT VARIANCE MATRIX (ICOMV=0) 

READ! 5, 100) I ( V( I, J ) , J*l* 3) , 1*1 ?3 ) 

GO TO 1 
DO 20 1=1*3 
DO 20 J” 1 * 3 
V ( I , J ) = 0. 

V ( I , J ) =1 -0 


I F ( I . EO. J ) 

20 CONTINUE 
1 IPV=0 
IPVTM=0 
1 PTRA J =0 
I F I L E = 0 
I MTX= 1 
I TER=0 
ITERD=0 

DTR=1 • 74532925 19943296D-2 

ERRMAX=ERRMXM/AUM 

IF ( ITAR.GT.O) GO TO 23 

ay=aym/aum 

az=azm/aum 

atar=dtr*atard 

23 TDAYF=TDAY0+TTRIPD 
TTRIP=TTRIPD/UTIME 

tstart=tdayo/utime 
tend=tdayf/utime 
AL PH'A- 1 * 00—3 
beta=io. 
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AtPHAM=ALPHA/( 1 •-ALPHA) 

BETAM=8ETA/!BETA-1. ) 

WR I TE ( 6 » 102 ) 

WR!TE( 6, 103)GLlf AUMfUT-IMEtUVELHfERRMXMfERRMAX 
WRITE( 6f 104)MSfMEf MMf 0 INCDf OBLD 

WRITE ( 105)TDAY0? TTRlPDf TDAYF fT START f TtRIP »TENO 
VIR1TE(6, 106)RSEOtVSEO 
WR1TE(6,107)RSM0,VSM0 
WR I TE ( 6 1 108 ) VE VMAG » LONO » THEO» REV MAG 
WRITE! 6, 109) ALPHA * BETA, EPS* EP ST SI ? KDX,EPSV 
WRITE! 6, 110) ICOMV* ITERMXt IFlLEXt ITAR 
lF(lTAR.GT.O) GO TO 24 
. WRlTE(6 t 124)AYM,AZM f ATARD 
GO TO 25 

24 WRITE(6 f 125)RSVTARfVSVTAR 

25 LON=DTR*LOND 
THE=DTR*THED 
OINC=DTR*OINCD 
OBL=DTR*OBLD 
XS ( 1 ) =VE VMAG 
X$!2)*L0N 

XS! 3 ) =THE 

COMPUTE INITIAL NOMINAL TRAJECTORY ' 

CALL COME G( T START f TEND f RE VMAG > X S f 01 NC f OBL f RSEG f VSEO f R SMO f V SMO 
lES»TESTRStGS,TSISf LTS»SllS»S12S»S21StS22StUVI StUVFS) 

I TER = 1 

CALL COMAUG! F S, GS * TS I S * LT S t V ♦ LS t FGS t GGS ) 

IF! ICOMV.EO.O) GO TO 200 

OPTION TO COMPUTE TRIAL VARIANCE MATRIX UCOMV-ll 
GGSMAG=VMAG ( GGS ) 

00 2 l=lt3 
DO 2 J=l»3 

V( I,J) = V( I*J)*EP5V/GGSMAG 

2 CONTINUE 

200 WR ITE ( 6* 11 1 ) ( ! V( I » J ) f J= 1 » 3 ) * 1 = 1 *3 ) 

SAVE VARIANCE MATRIX 
DO 3 1 = 1 » 3 
DO 3 J = 1 ? 3 

3 VS AV ! It J)=V! If J ) 

KV= 1 • 

KDXSAV=KDX 

IF(TESTRS.GT.EPSTSI)GO TO 8 

UPDATE VARIABLES _ 

CALL UPX!XSfFSfTESTRSfGSfTSlSfLTSfLSfFGSfGGSfSllSfS12SfS21Sf 
1 S2 2S f UV I S f UVF Sf XfFfTESTRfGfTSIfLTfLfFGf GG fSllfSl2fS21fS22f 
2UVIfUVF) 

WRlTE!6,112)XfF,FGfTESTR 
WRITE!6rll3)TSIfG 
WRITE!6f U4)LT 
WR I TE ! 6 f 1 1 5 ) GG 

ACCELERATED GRADIENT PROJECTION ITERATION LOOP 
A- ITERD=ITERD + 1 
5 DO 501 I = 1 f 3 
DO 501 J-l f 3 
501 V! If J)=KV*VSAV( 1,J) 

1 6 CALL MXV!V f GG,Rf3f3) 

RsDOT ( GGf Rf 3 > 



1F( (P-2.*FG).LE.EPS> GO TO 7 

L AM = 2 • * FG/P 

CALL VVT ( R , TEMP , 3 ) 

DO 601 1= 1 1 3 
DO 601 J = 1 » 3 

601 VSAV(l t J)=Vn,Jl + l LAM-1. >*TEMP( I , J)/P 
GO TO 5 

7 CALL MXV( V, GG*DX,3*3) 

C FORM TRIAL NEW INDEPENDENT VARIABLES 

DO 701 1*1,3' 

701 XS( I)*X( I ) — DX( I) 

WR I TE ( 6 , 1 1 6 ) I TERD, DX 

WRITE(6 f 117)XS»KV 

WRITE (6,lll)((V(I,J)t J* 1 ,'31,1 = 1,3) 

CALL COMFGI TST ART, TEND, REVMAG,XS»OINC,OBL,RSEO,V$EO,RSMO,VSMO, 
IPS, TE$TRS,GS,TSIS,LTS,S11S,S12S, S21 S , S22S ,UVI S,UVFS ) 

CALL COM AUG I FS,GS,TSIS,LTS,V,LS»FGS»GGS) 

IF(TESTRS.LT.EPSTSI) GO TO 11 
C CONSTRAINT RESTORATION 

8 WRITE(6,il8) 

801 CALL COMOX(LTS,LS,TSIS,DX> 

WRITE(6»119)DX 

9 DO 901 1-1,3 
DELXM ) =KDX*DX ( I ) 

901 XD( I )=XS( I M-DELXI I ) 

WRITE! 6,120)KDX»DELX 

CALL COMFGI T START, TEND, REVMAG,XD,OINC,OBL,RSEO,VSEO,RSMO,VSMO, 
I FD, TESTRD,GD, TS1D, LTD* SI ID, S12D, S21D, S22D.,UVIO,UVFD 1 
IF(TESTRD.LT.TESTRS) GO TO 10 
KDX=KDX/10* 

WRITE! 6, 126) 

GO TO 9 

10 CALL COMAUG(FO,GD,TSID,LTD,V,LD,FGD,GGD) 

CALL UP XI XO, FD,TESTRD,.GD,.TSID, LTD, LD,FGD,GGD, S11D,S12D, S2 ID, 
1S2.2D,UVI D,UVFD*XS»FS*TESTRS ,G$,TSI S ,LTSt LS,FGS ,GGS»$1 IS, S.12S » 
2S21S,$22S,UVIS,UVFS> 

KDX=2.*KDX 

IF(KDX*GT. 1.0)KDX=1.0 
IF(TESTRS.GT.EPSTSI) GO TO 801 
KDX=KDXSAV 

I F ( ITERD.EO.O) GO TO 11 
I F ( FS* L T* F ) GO TO 11 
KV=KV/2. 

GO TO 5 

C CONSTRAINT RESTORED 

11 IF( ITERD.LT. ITERMXJGO TO 300 
WR I TE l 6 , 12 7 ) 

GO TO 17 

300 l F 1 I TERD • EO >0 ) GO TO 16 
C UPDATE VARIANCE MATRIX 

CALL MXV(V,GGS,R,3,3) 

P=DOT I GGS,R, 3 ) 

WRI TE ( 6, 121 IFSfTESTRStFGSrTSIS 

WRlTE(6,122)GS,GGS 

WRITE(6,123)P 

IF(P-LT.EPS) GO TO 17 

GAMMA* -DOT ( GG , R, 3 ) /P 
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1F(GAMMA.E0. ( “1 • ) ) GO TO 12 
I F( GAMMA* GE« ALP-HAM) GO TO 13 
LAM»ALPHA 
GO TO 14 

12 IF (GAMMA. LE. ( -BET AM ) ) GO TO 13 
LAM=BETA 

GO TO 14 

13 LAM=GAMMA/ ( GAMMA+1* ) 

14 CALL VVT ( R> TEMP » 3 ) 

00 15 1 = 1,3 

DO 15 J = 1 » 3 

15 V( ItJ)=V(ItJ)+( L AM“1 • )*TEMP ( It J)/ p 
IF(FGS.LT.FG) GO TO 16 

GO TO 6 

C ALL UPX( XStFStTESTRStGSt TSIStLTS tLSt FGS tGGStSllSt S12StS2.1St 
lS22StUVIStUVFSt XtFtTESTRtGtTSI t Lit L t FG t GG t S 1 1 t S 12 t S2 1 t S22t 
2UV1 ?UVF ) 

I F ( ITERD.EO.O) GO TO 4 
DO 161 1*1 t 3 
DO 161 J=lt 3 
161 VSAV<ltJ)*V( ItJ) 

17 CALL UPX ( XStFStTESTRStGSt TS I StLTStLSt FGS tGGS , S 1 1 S t S 1 2 S t S2 1 S t 
!S22StUV IStUVFSt XtFtTESTRtGtTSI tLT f Lt FGtGGtSll t SI 2t S21tS22t 

2 UVltDVF) 

C COMPUTE PRIMER VECTOR DERIVATIVE 

CALL MXV(SlltUVItDUM,3t3) 

CALL INVERT(S12,TEMP) 

DO 18 1=1*3 

18 DUM( I )=UVF( I )“DUM( I ) 

CALL MXV(TEMPtDUMtDUVI f 3t3) 

DO 400 I * 1 1 3 

PVO ( I)«uvt( 1 ) 

400 PVO( 1+3 )»DUV 1(1) 

IPV=1 


TRAJECTORY AND PRIMER VECTOR HISTORY 


I P VTM= 1 
I PTRA J=1 
IFILE=IFILEX 
GENERATE OPTIMAL 
VE VMAG= X ( 1 ) 

LON«X ( 2 ) 

THE - X ( 3 ) 

CALL COM ICtREVMAGtVEVMAG, LON, THE tOINCtOBLtRSEOt VSEO, REVO tVEVOt 
IRSVOtVSVOtVSVI) 

CALL FOURBY( T START tTEND , R SVO , V SVI ,RSEO , V SEO ,R SMO , 
lVSMOt PVOtRSVF,VSVF,RSEF,VSEF, RSMF tVSMF, SI 1 1 S12,S2 1,S22) 

100 FORMAT ( 4D20. 1 1 ) 

102 FORMAT ( 1H ,T8, '4-BODY 2-IMPULSE OPTIMAL TRANSFER FROM EARTH 1 / 
11H , T8, * TO HALO TARGET AT LI. ITERATE ON VELOCITY MAGNITUDE'/ 
21H , T8 , • , LONG I TUDE OF NODE AND ORBITAL ANGLE FROM NODE USING'/ 
31H ,T8, 'ACCELERATED GRADIENT PROJECTION AND DAVI DON VARIANCE'/ 
41H » T 8 * ' METHOD • ) 

fl03 FORMAT ( 1H0 , T 8 , ' GL 1 » , T28 , ' AUM* , T48 , » UT I ME • , T68 , *UVELM ' »T88 , 
1»ERRMXM» ,T108,'ERRMAX»/1H t 1P6D20.11) 

104 FORMAT ( 1H , T8, « MS • , T2 8, • ME * , T48 , • MM • , T68 , * OINCD ' , T88 , 'OBLD' / 
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11H » 1 P5D20 • 1 1 ) 

105 FORMATUH vT8v 1 TDAYO' »T28 » 'TTRIPD' vT48v 'TDAYF' # T68v * TSTART * 

1 T88 1 ♦ TTR I P • * T 1 08 1 ' TEND * / 1H v 1P6D20.11) 

6 FORMATUH » T8 * 1 RSE 0 • ♦ T68 1 1 VSEO • / 1H vlP6D20.ll) 
tu 7 FORMAT ( 1 H t T8v »RSMO» ,T68, 'VSMO'/IH vlP6D20.ll) 

108 FORMAT ( 1H t T8t • VEVMAG • t T 28 , • LOND ■ t T48 t • THED* v T68 t ' REVMAG • / 

11 H , 1P4020.U) . TOO 

109 FORMAT { 1H t T 8 , « ALPHA • v T28 » 1 BET A 1 » TAB ♦ • EPS • v T68 * EP ST S I »T88» 

1 * KDX * » T 1 08 1 1 E P S V 1 / 1 H , 1P6D20.U) 

110 FORMAT ( 1H » T 8 » 1 I COMV ' v T28 , * I TERMX • v T48 , U F I LEX • 1 T68 , ITAR / 
ilH ,110,3120) 

111 FORMAT ( 1H0* T 6» , V , /1H vlP6D20.il/lH v 1P3D20.11) ^ _ 

112 FORMAT (1 HO f T8r •X , ,T68v , F , »T88f , FG*vTl08» •TESTR* /1H » 1P6D20.11) 

113 FORMATUH , T 8 v • TS I ' v T68 , 1 G * / 1H «1P6020.11) 

UA- FORMATUH f T8v , LT , /l H vlP6020.il/lH vlP3020.ll) 

115 FORMATUH vTBv’GG'/lH vlP3020.ll) 

116 FORMAT( 1H1 r T8v * 1TERD* vT28v 'DX* /1H v 1 10 v 10X , 1P3D20 . 1 1 ) 

117 FORMATUH ,T8 v ' XS' vT68v ' KV* /1H viP4D20.ll) 

118 FORMAT ( IHOv T8t 'CONSTRAINT RESTROAT ION 1 ) 

119 FORMAT ( IHOvTSv 'DX' / 1H vlP3020.ll) 

120 FORMATUH v T 8 v • KDX • , T28 v ' DELX » / 1H tlP4D20.ll) 

121 FORMATUH 9 T8 * ' FS • * T28 » ' TEStRS 1 v T48 1 1 FGS • v T68 t ' T S I $ /1H t 


120 FORMATUH 

121 FORMATUH 
11P6D20.11) 

122 FORMAT ( 1H 

123 FORMATUH 


vT8, 

t T 8 v 


• GS • v T 68 v 1 GGS • / 1H , 1P6D20.11) 
•P'/1H ,1PD20.U) 


124 FORMAT! IHOvTSv • AYM' vT28, * AZM* vT48» 'ATARD'/IH * 1P3D20.11) 

125 FORMAT! lH0fT8t 1 INPUT TARGET'/lHOvTS v'RSVTAR* vT68 , 1 VSVTAR 1 / 


11H , 1P6D20.11) 

126 FORMAT { 1H0 vT8 v 1 

>27 FORMAT ( lH0,T8v'N0, 
RETURN 
END 


OF DAVIDON ITERATIONS HAS REACHED MAXIMUM') 
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C 


C 


PROGRAM ETP2I3 

PROGRAM COMPUTES FUEL OPTIMAL 2-IMPULSE TRANSFER FROM A I PARK ING 
0R8IT OF GIVEN INCLINATION TO A GIVEN FINAL POSITION AND VELOCI Y 
IN F1XEO TIME IN EARTH-MOON-VEHICLE SPACE. 

IMPLICIT REAL*8( A-H, K-M , O-Z ) ' • mchtaoi** 

DIMENSION REMO ( 3 ) , VEMO ( 3 ) , XD ( 3 ) ,X ( 3 ) , X S ( 3 ) »R-EVT, AR ( 3 ) * VEVTAR ( 3 > t 

1V( 3,3),GS(3),TSIS(3) ,LTS(3,3) ,LS(3,3> ,S11S(3,3 S12S J. 3 **.}* 

2S21S(3,3),GGS{3I ,VSAV(3,3),G(3> ,TSI(3) ,LT(3,3> ,L(3,3) ,GG(3) , 

3S1 1 ( 3, 3 ) , S12 ( 3, 3 ) ♦ S21 ( 3, 3 ) * $22 ( 3 1 3 ) * DX ( 3) *OELX (3 1 ,UVI ( 3 ) *UVF ( 3 ) * 

4TEMP< 3,3) ,DUM<3) , UV I D( 3 ) , S22S ( 3 ,3 ) , PVO ( 6 ) »GGD( 3 ) _ 

DIMENSION R(3),REVOI3),VEVO(3),VEVOP(3),UVIS(3),UVFM3),UVFD(3), 

1GD(3) ,TSID(3) ,LTD(3,3) , LD ( 3 , 3 ) , SI ID t 3 , 3 ) , S 1 2Dt 3 ,3 ) , $2 ID (3,3) , 

2S22DO,3> t REVF(3)tVEVF(3)tREMF<3),VEMF(3) tDUVI (3) 

COMMON/FLAG/ IMTX, IPV, I PTRAJ, I PVTM, IFILEv ITER, I TAR 

COMMON/ CON ST3 /ME , MM , GAMMA , UDM, UT I ME , UVELM , ERRMAX , DTR — 

COMMON/T ARG/AY ,AZ,ATAR,REVTAR,VEVTAR 

RE AO ( 5, 100 ) GAMMA , UDM, UT IME, UVELM 

READ(5,100)ME,MM 

READ! 5, 100) REVMAG, OINCD, ERRMXM 

RE ADC 5,1001 TDAYOtTTRIPD 

READ! 5, 100)VEVMAG,LOND,THED 

RE AD (5, 100) REMO, VEMO 

RE ADC 5, 100 ) EPS, EPSTSI ,KDX , EPSV 

READC 5,101 ) ICOMVt I TERMX , I F I LEX » I TAR 

I F ( ITAR.GT.O) GO TO 21 

READ(5,100)AYM,A2M,ATARD 


GO TO 22 

21 READ<5,1O0>REVTAR,VEVTAR 

22 I F ( I COM V. GT • 0 ) GO TO 19 ■ 

OPTION TO INPUT VARIANCE MATRIX (IC0MV=0) 
READ! 5, 100) (<V(l,J),J=l,3)»I=lt3) 

GO TO 1 

19 DO 20 1=1,3 
DO 20 J= 1 ,3 
V( U J)=0. 

IF(I.EO.J) VI I, J) = 1.0 

20 CONTINUE 
1 IPV=0 


I P VTM=0 
I PTRA J=0 
I F I L E = 0 
I MTX=1 


I TER=0 
ITERD=0 

DTR=l. 74532925 19943296D-2 

ERRMAX=ERRMXM/UDM 

IF C ITAR.GT.O) GO TO 23 

AY=AYM/AUM 

az=azm/aum 

atar=dtr*atard 

23 TDAYF=TDAY0+TTRIPD 

ttrip=ttripd/utime 

tstart=toayo/utime 

TEND=TDAYF/UT1ME 
AL PHA= 1 • OD-3 
BETA= 10. 

ALPHAM=ALPHA/C 1. -ALPHA ) 
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flETAM=0ETA/ (BETA-1 # ) 


WRIT E ( 6 » 1 02 ) 

WRITE( 6, 103)GAMMA*UDM,UTIME* UVELM , ERRMXM * ERRMAX 
WRITE(6*104 ) ME t MM * OINCD ' 

WRITE (6* 105)T0AY0*TTRIPD,TDAYF tTSTARTf TTRlPt TEND 

WR I TE ( 6* 1G6 ) REMO* VEMO 

WR1 TE!6* 108>VEVMAG,LOND*THED*REVMAG 

WRITE! 6, 109) ALPHA, BETA, EPS* EPST$I»KDX,EPSV 

WRITER* 110) ICOMV* ITERMX* IFILEXtlTAR 

I F ( ITAR.GT.O) GO TO 24 

WRITE! 6, 124)AYM*AZM, ATARD 

GO TO. 25 

24 WR ITE ( 6* 125 ) REVTARt VEVTAR 


25 LON=DTR*LOND 
THe=DTR*THED 
OINC=DTR*OINCD 
XS(1)=VEVMAG 
XS ( 2 ) =LON 
XS ( 3 ) = THE 

COMPUTE INITIAL NOMINAL TRAJECTORY 

CALL C0MFG3(T ST ART, TEND, REVMAG ,XS*01NCtREMO, VEMO *F 
lTSIS,LTStSHS,S12S,S21S,S22S»UVIS»UVFS) 

I TER= 1 

CALL COMAUG!F$*GStTSIS*LTS*V*LS*FGS*GGS) 
IFUCOMV.EO.O) GO TO 200 

OPTION TO COMPUTE TRIAL VARIANCE MATRIX (IC0MV=1) 


S *TESTRS *G$ 


GGSMAG=VMAG ! GGS ) 

DO 2 1=1,3 
00 2 J=1 t 3 

V( I*J)=V( I,J)*EPSV/GGSMAG 
2 CONTINUE 

200 WRITE(6tUl) < ( V( I , J ) t J« 1 * 3 ) * I «1 » 3 ) 
SAVE VARIANCE MATRIX 


DO 3 1 = 1*3 
00 3 J = l*3 
3 VSAV! If J)=V( It J) 


K V = 1 • 


KDXSAV»KDX 

I F ( TESTRS • GT *EPSTS I ) GO TO 8 

CALL T 'UPXUSf FS*TESTRS*GS*TSlSf LT S * LS , FGS * GGS * S 1 1 S , S 1 2 S * S21 

1 S22St UV I S t UVFSt X» F > TE $TR »G t TS 1 1 LT » L t FG t GG t S 1 1 1 S12 1 S2 1 1 S22 f 

2UV 1 *UVF ) 

WRITE! 6*112)X*F*FG*TE$TR 


St 


WRlTE!6,113)TSlfG 

WRITE(6,11A)LT 

WRITE!6,115)GG 

ACCELERATED GRADIENT PROJECTION 
A 1 TERD* I TERD+ 1 

5 00 501 1=1*3 
DO 501 J=l*3 

501 VI I * J ) = KV*VSAV( I*J) 

6 CALL MXVIV,GG,R*3*3) 

P=DOT ( GG* R * 3 ) 

I F I ! P-2 ♦ * F G ) • L E * E P S ) GO TO 7 


ITERATION LOOP 


LAM=2.*FG/P 
CALL VVT ! R * TEMP * 3 ) 



DO 601 1=1*3 
DO 601 J = 1 * 3 

601 VSAVl l t J)=VU,J ) + ( LAM-1. )*TEMP( 1 *J)/P 
GO TO 5 

7 CALL MX V ( V t GG* DX *3*3) 

FORM TRIAL NEW INDEPENDENT VARIABLES 
DO 701 I=lt3 
701 XS< 1 ) * X 1 1 > — DX < I ) 

WRITE! 6,116)ITERD,DX 
WRITE(6*117)XS*KV 

WRITE 16*111 ) (IV! 1*J)*J=1*3)* 1=1*3) 

CALL CQMFG3 ( T ST ART *TEND*RE VMAG * XS *OINC *R EMO * VEMO *F S * TESTRS *G S * 
1TS1S*LTS*S11S*S12S* S2 1 S * S22S * UV I S * UVFS ) 

CALL COMAUGl F S * GS *T S I S * LT S * V , L S * FG S *GGS ) 

IFITESTRS.LT. EPSTSI) GO TO 11 
CONSTRAINT RESTORATION 

8 WRITE(6,118) 

801 CALL COMDXl LTS*LS*TSIS*DX) 

WR 1 TE 1 6* 1 19 ) DX 

9 DO 901 1=1*3 

DEL X ( 1 )=KDX*DX! I) 

901 XD( I)=XS1 D+DELXl I) 

WRITEI6,120)KDX t DELX ' ^ _ 

. CALL C0MFG3 ( T ST ART * TEND ,REVMAG*XD, 01 NC* REMO* VEMO * FD * TE STRD *GD * 
1 TSI D* LTD, SI ID* S 12D* S2 1 D* S22D* UVI D* UVFD ) 

IFITESTRD.LT. TESTRS) GO TO 10 
K0X=KDX/10. 

GO TO 9 

10 CALL COMAUGl FD*GD*TSID*LTD*V*LD,FGD,GGD> 

CALL UPX ( XD * FD*TESTRO*GO* TSID,LTD*LD*FGD *GGD * SI ID, SI 2D, $2 ID* 

1 S22D* UV 10, UVFD* XS * F S, TESTR S , GS , TSI S* LTS ,L S , FGS ,GGS* SI IS * S 1 2 S, 
2S21S*S22S*UVIS*UVFS) 

KDX=2.*KDX 
IF1KDX.GT.1. ) KDX= 1 . 

IF(TESTRS.GT.EPSTSI) GO TO 801 
KDX=KDXSAV 

I F 1 ITER.EQ.O) GO TO 1 1 
IF1FS.LT.F) GO TO 11 
K V=K V/2 • 

GO TO 5 

CONSTRAINT RESTORED 

11 IFHTERD.LT. ITERMXJGO TO 300 
WRITE(6,126) 

GO TO 17 

300 IF! ITERD.EO.O)GO TO 16 
UPDATE VARIANCE MATRIX 
CALL MX V 1 V * GGS * R * 3 , 3 ) 

P=DOT ( GGS * R * 3 ) 

WR ITEC6* 121 )FS* TESTRS, FGS* T SIS 

WRITE! 6*122) GS *GGS 

WRITE! 6* 123 )P 

IF1P.LT. EPS) GO TO 17 

GAMMA =- DOT 1 GG* R *3 ) /P 

IF1GAMMA.EQ.1-1.) ) GO TO 12 

I F ( GAMMA. GE. A L PHAM ) GO TO 13 

lam=alpha 

GO TO 14 
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12 I F ( GAMMA • LE . { -BE TAM ) ) GO TO 13 
LAM=BETA 
GO TO 14 

|3 LAM=GAMMA/<GAMMA+1. ) 

~14 CALL VVT { R , TEMP , 3 ) 

DO 15 1 = 1,3 ... 

DO 15 J= 1 , 3 

15 V< I , J)=V< I, J)+I LAM-1. )*TEMP(I t J )/P 
1FTFGS.LT.FG) GO TO 16 
GO TO 6 

CALL UPX( XStFStTESTRStGStTSlStLTStLS,FGStGGStSllStS12StS21S, 
lS22S,UVIStUVFS,X,F,TESTR,GtTSI ,LT , L ,FGtGG , SI It SI 2 >S2 1 tS22 , 
2UV I , UVF ) ’ 

I F ( ITERD.EQ.O) GO TO 4 
DO 161 1=1,3 
DO 161 J=1 , 3 
161 VS AV ( I, J)=V( I,J) 

17 CALL UPX(XS,FStTESTRS,GStTSlS,LTStLStFGStGGS,SllStS12S,S21St 
1S22S , UVI S , UVFS , X , F , TESTR ,G , TS I ,LT ,L,FG ,GG, Sll , S12,S21 , S22 , 

2 UVI, UVF) 

C COMPUTE PRIMER VECTOR DERIVATIVE 

CALL "MXVrSl 1 ? UVI ,DUM, 3,3 ) 

CALL INVERT ( S12 ,TEMP ) 

DO 18 1=1,3 

18 OUMtl)=UVF( I)-DUM(I> 

CALL MX V ( TEMPfDUM, OUV 1,3,3) 

DO 400 1=1,3 
PVO( I } =UV I ( I) 

400 PVO( I +3 ) =DUV I ( I ) 

IPV=1 
I PVTM = 1 


C 


I PTRAJ= 1 
ifile=ifilex 

GENERATE OPTIMAL 
VEVMAG=X( 1 ) 


TRAJECTORY AND PRIMER VECTOR HISTORY 


LON= X ( 2 ) 

THE=X ( 3 ) 

CALL COMIC3(REVMAG,VEVMAG,LON,THE,OINC,REVOtVEVOtVEVOP) 

CALL THR6DY( T START, TEND, REVO, VEVOP, REMO ,VEMO,PVO,REVF ,VEVF , 
1REMF , VEMF , $1 1 1 S 12 , S2 1 , S22 ) 

100 FORMA TI4D20.il) 

102 FORMATUH , T 8 , 1 3-BODY 2-IMPULSE OPTIMAL TRANSFER FROM EARTH*/ 
11H , T 8 , 'TO HALO ORBIT AT LI OR L2. ITERATE ON VELOCITY'/ 

21H ,T8, 'MAGNITUDE, LONGITUDE OF NODE AND ORBITAL ANGLE 
31H , T8 , ' NODE USING ACCELERATED GRADIENT PROJECTION AND 
41H , T8 , ' DAV I DON VARIANCE METHOD*) 

103 FORMAT { 1 HO, T8 , * GAMMA ' , T28 , »UDM' ,T48, 'UTIME * , T68 , ' UVELM ' , T88 , 
l'ERRMXM' ,T 108, • ERRMAX' /1H , 1P6D20 • 1 1 ) 

104 FORMAT ( 1H , T8 , ' ME » , T2 8 , » MM * , T48 , » 0 1 NCD ' / 

11H , 1P5D20.11) 

105 FORMAT i 1H ,T8,'TDAY0* , T28 , » TTRI PD * , T48 , » TDAYF » , T68 , ' TST ART • , 

it 88, * TTR IP. 1 ,T108, 'TEND' /1H ,1P6D2Q.11I 
— ,06 FORMAT ( 1H , T8 , • REMO « , T68 , ' VEMO * / 1H , 1P6D20.11) 

!08 FORMAT (1H , T 8 , 1 VE VMAG *! , T28 , * LOND ' ,T48,'THED' , T68 , 1 REVMAG • / 


FROM'/ 

'/ 
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1 IN t 1 P4D20. 1 1 ) 

109 FORMAT (1H ,T8, 1 ALPHA* » T28 t 1 BETA* t T48 t * EPS* ?T68 t * EP STS I 1 *T88* 
l‘KDX*tTl08,'EPSV'/lH tlP6D20.11) t , 

p FORMATUH ,T8, * ICOMV* »T28t * ITERMX* ,TA8, • IF1LEX* f T68f 1 1TAR / 

1 1H t I 10t 3 I 20 ) • 

Ill FORMAT(1HO,T8 t*V'/ 1H , 1P6D20,11/1H t 1P3D20. 1 1) 1£>An5n 

FORMAT { lH0»T8 t *X'fT68t , F'tT88t , FG , tT108T , TESTR*/lH t 1P6D20. 1 1 ) 
FORMAT ( 1H t T8, *TSI * »T68 t , G* / 1H tlP6D20.ll) 

FORMAT ( 1H ,T8,*LT'/1H tlP6D20.il/lH tlP3D20.11> 

FORMAT (lH,T8t*GG , /lH , 1P3D20.11) ; , 4 

FORMAT ( lHl,T8t , lTERD , tT28t , DX*/lH tllOt lOXt 1P3D20.11) 

FORMATUH * T 8 , » XS * t T68 t 1 KV • / 1H , 1P4D20.11) 

FORMAK lH0tT8t ‘CONSTRAINT RESTROATI ON* ) 

FORMAT (lH0tT8t *DX*/1H tlP3D20.ll) 

FORMATUH ,T8 , 1 KDX » , T28t * DELX • / 1H tlP4D20.ll) ■ 

FORMATUH , T 8 1 1 F S 1 t T28 t 1 TESTRS 1 t T48 t 1 FGS * t T68 t TSIS /1H t 

11P6D20.11) 

122 FORMATUH , T 8 1 * GS * t T68 t * GGS * / 1H , 1P6D20.11) 

123 FORMATUH tT8,'P*/lH , 1PD20.11) 

124 FORMAT ( lH0tT8 t 1 AYM* r T28t * AZM * t T48 t * ATARO * /1H tlP3D20.11) 

125 FORMAT* lH0 t T8t ‘INPUT TARGET »/ 1 HOt T 8 1 1 RE VTAR ‘ , T 68 1 1 VEVTAR •/ 1H t 

126 FORMAT ( lHOt T 8t 1 NO. OF DAVIDON ITERATIONS HAS REACHED MAXIMUM') 
RETURN 

END 


112 

113 

114 

115 

116 
117 
.118 

119 

120 
121 
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o o O 


PROGRAM PTP3I 

PROGRAM COMPUTES FUEL OPTIMAL 3-IMPULSE TRANSFER FROM A GIVEN 
INITIAL POSITION TO A GIVEN FINAL POSITION AND VELOCITY IN 
FIXED TIME- 

IMPLICIT RE AL*8 ( A—H, K— M, 0-7 > 

DIMENSION X(4) ,G(4) ,V<4,4) , X S ( 4 ) , GS ( 4 ) »R ( A- ) ,DX(4) ,RSV0(3) , 

1VSV0(3),RSE0<3) ,V$EO(3),RSMO(3),VSMO(3>,VSVI (3>, 

2TEMPl(4,4) , SFM 1 1 S ( 3 , 3 ) ,SFM12S( 3,3) , SFM21S(3,3) ,SFM22S(3,3) , 
3SMI11S(3,3),SMI12S(3,3),SMI21S(3,3),SMI22S( 3,3 ) ,RSVM {3 ) r 

4 VS VMP ( 3 ) ,RSVMS( 3 ) ,VSVMPS( 3) ,OUVI S (3) ,DUVMMS( 3 ) t 

5DUVMPS ( 3),DG(4),VS(4,4),DXC(4),XC(4> ,RSVMC(3) ,VSVMPC(3 ) , 

6UVICI 3) ,UVMC( 3) , UVF C ( 3 ) , DUV l C < 3 > , OUVMMC ( 3 ) ,DUVMPC (3) »PC(4) , 

7SMI11C<3,3),SMI12C(3,3),SMI21C(3,3),SMI22C(3,3),SFM11C(3,3) , 

8SFM1 2C (3,3 ) , SFM2 1C ( 3 ,3 ) , SFM2 2C < 3 , 3 ) , R SVMDI 3 ) ,VSVMPD(3) ,UVIS(3) 
9UVMS ( 3 ) , UVF S ( 3 ) , S< 4 ) , SFM 1 1 < 3, 3 ) , SFM 1 2 < 3 , 3 ) , SFM2 1 ( 3 , 3 ) , 

1SFM22 ( 3,3) ,UVI (3) ,UVM( 3 ) ,UVF ( 3 ) ,OUVI ( 3 ) ,DUVMM( 3) ,DUVMP ( 3) , 

2SMI 11< 3,3) , SM 112(3,3) ,SMI21(3,3) ,SMI22(3»3) ,PV0(6) ,PVM (6 ) , 
3RSVTAR(3 ) , VSVTAR( 3) ,SFM11D( 3, 3) ,SFM12D(3,3) 

DIMENSION V SVMM ( 3 ) , RSEM { 3 ) , VS EM ( 3 ) ,RSMM(3) ,VSMM(3) , 

1 RSVF ( 3 ) , VSVF ( 3 ) ,RSEF(3) ,VSEF( 3) , R SMF ( 3) ,VSMF< 3) 

DIMENSION DGC(4) , VC ( 4,4 ) ,GC ( 4 ) , VSVMMS ( 3 ) ,VSVMMC(3 ) 

COMMON/C ONST /MS, ME,MM,GL1 ,AUM,UT1ME ,UVELM,ERRMAX ,DTR 

COMMON/ F LAG/ I MTX, IPV, IPTRAJ, IPVTM, I F I LE , I TER , 1 T AR 

READ ( 5 » 1 00 ) GL 1 , AUM ,UT 1 ME ,UVELM 

RE AD ( 5 , 100)MS,ME, MM 

READ( 5,100)TSTART,TM,TEND 

READ{ 5, 100)RSE0,VSE0,RSM0,VSMC 

READ(5,100)RSV0,VSV0 

RE AD ( 5 , 100 ) VSV I , VSVMP 

READ! 5,100 ) RSVT AR , V SVT AR 

RE AD ( 5 , 100)KNR,ERRMIN,ERRMXM 

READ(5,100)FMINM,EPS,EPSV 

READ ( 5, 101 ) ICOMV, ITLMAX, I L INC , I TDM AX , I F 1 LEX 
IFI ICOMV.GT.O)GO TO 190 

OPTION TO INPUT VARIANCE MATR I X { I C0MV=0 ) 

READ ( 5 , 100 ) t ( V ( I , J ) »J = 1*4) ,1 = 1,4) 

GO TO 1 

190 DO 200 1=1,4 
DO 200 J= 1 , 4 
VII,J)=0. 

I F ( I . EO. J ) V(I,J) = 1.0 
200 CONTINUE 

1 DTR=1. 74532925199432960-2 
errmax=errmxm/aum 
FMIN=FM inm*uvelm 
knrsav=knr 

AL PM I N= 1 • 00-8 

WRITE (6, 102)GL1, AUM ,UT I ME ,UVELM , ERRMXM , ERRMAX ,MS ,ME ,MM 

WRITE (6, 103)TSTART,TM,TEND,RSVO,VSVO,RSEO,VSEO,RSMO,VSMO 

WRITE(6,104)VSV1,VSVMP,RSVTAR,VSVTAR 

WR1TE(6, 105)KNR,ERRMIN,FMINM,EPS,EPSV 

WRITE (6, 106) ICOMV, ITLMAX, I L INC, I TDMAX, IF ILEX 

IPV = 0 

I PVTM = 0 

IFILE=0 

I pTRA J=0 

IMTX=1 
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ITERD=0 
00 2 1=1,3 
? X ( 1 )=VSVI ( I > 

X( A)*=1M 

COMPUTE INITIAL NOMINAL TRAJECTORY 

CALL COMF1 TST ART, TM, TEND, RSVO,VSVO,VSVI ,RSEO,VSEO,RSMO, VSMO, 
1ERRMIN, ILINC,KNRSAV, ITERO , I TLMAX ,RSVMD ,VSVMPO ,RSVTAR , VSVTAR , 
2SFM1 ID, SEMI 2D, RSVM, VSVMM,VSVMP, F ,UV I , UVM,UVF , SMI 1 1, 

3SMI 12, SMI21,SMI22,SFMU , SFM 1 2 , SFM2 1 , SFM22 ) r w 

CALL COMG( SMI 11, SMI 12, SMI 21, SMI 22, SFM 11 , SFMl 2 , VSVMP , VSVMM , UV I , 
1UVM,UVF, DUV I , OUVMM , DUVMP ,G ) 

GMAG=DSORT ( DOT ( G,G» A).) 

WR I TE ( 6, 108 ) F , G , GMAG 
DO 3 1=1,3 
RSVMDI I )=RSVM( I) 

VSVMPDI I ) =VSVMP( I ) 

DO 3 J=1 ,3 

SFMl ID ( I , J ) = SFM 1 1 ( It J) 

3 SFM12D( I ,J)=SFM12l I , J) 

I F ( ICOMV.EQ.O) GO TO AO 

OPTION TO COMPUTE TRIAL VARIANCE MATRIX (ICOMV-1) 

DO A 1=1, A 
DO A J = 1 , A 

V( I , J ) = V { I,J)*EPSV/GMAG 
A CONTINUE 

AO WR I TE ( 6, 107 ) ( (V( I,J) ,J=1,A), 1=1, A) 

ACCELERATED GRADIENT ITERATION LOOP 

5 I TERD= I TERD+ 1 
WRITE! 6, 109 I ITERO 

l CALL MXV( V,G,S,A,A) 

DO 50 1=1, A 

50 S< I)=-S< 1 ) 

SG=DOT ( S ,G, A ) 

WRITE<6,110)S,SG 

I F ( SG*LT »0. ) GO TO 51 
DO 52 1=1, A 
52 S( I )=-S( I) 

SG=— SG 

WR I TE ( 6 , 1 1 1 ) S , SG 

51 AL P= ( FM IN— F ) / SG 

ALPHA = DM INK 1.00+0 , ALP > 

6 DO 61 1 = 1, A 

DX ( I ) = AL PHA* SCI) 

61 xs<u*x.m+DX(n 
DO 62 1=1,3 

62 vsvni>=xsm 

WRITE(6, 112) DX, ALPHA, XS 

CALL COMF(TSTART,XS(A) , TEND, RSVO , V SVO, V SV I ,RSEO,VSEO,RSMO,VSMO, 

1ERRM1N,1LINC,KNRSAV,ITERD,ITLMAX,RSVMD,VSVMPD,RSVTAR, VSVTAR, 

2 SFMl ID, SFM12D,RSVMS, VSVMMS, VSVMPS, FS,UVI S,UVMS,UVFS* SMI 1 IS, 
3SMU2S,SMI21S,SMI22S,SFM11S,SFM12S,SFM21S,SFM22S) 

CALL COMG( SMI 11 S, SMI 12S, SMI 21 S, SMI 22S, SFMl IS, SFM12S, VSVMPS, 
1VSVMMS,UVIS,UVMS, UVF S ,DUV IS, DUVMMS * DUVMP S ,GS ) 
GSMAG=DSORT(DOT(GS,GS,A) ) 

WRITE (6, 113)FS,GS,GSMAG 
DO 701 1=1, A 
701 DG( I )=GS( I ) —G ( I ) 


154 



c 


CALL MX VI V,DG,R,4,4) 


00 71 1=1,4 
71 R ( I ) = R ( I >-DX< I > 

, RMAG=DSORT t DOT ( R , R,4 ) ) 

P=D0T(DG,R,4) 

PMAG = DABS< P) 

$GS=00T<S,GS,4) 

WRITE (6, 114) DG,P,$G$,R,RMAG 
8 CALL VVTtR, TEMPI, 4> 

DO 81 1=1,4 
DO 81 J = 1 , 4 

81 V(1,J)=V(1,J) -TEMP 1 (I » J > /P 

82 1 F ( SGS. GT * 0# ) GO TO 83 
IF1FS.LT.FIG0 TO 14 
AL PHA= ALPHA/ 10* 0 

IF( ALPHA. LT.ALPMINIGO TO 84 
GO TO 6 

84 DO 840 1=1,4 
DO 840 J=l»4 
V( 1,J)=0. 

I F ( 2 • EO. J ) V( I,J> = 1. 

840 V( 1,J)=VU,J)*EPSV/GMA& 

WRITE(6,122) 

GO TO 40 

83 CONTINUE 

CUBIC INTERPOLATION BETWEEN X AND XS 

Z=3.*(F-FS)/ALPHA+SG+SGS 

W2=Z*Z-SG*SGS 

IFIW2.LE.0. )G0 TO 13 

W=DS0RT(W2) 

ALPHAC= ALPHA*! l.-( SGS+W-Z ) /( SG$-SG+2.*W ) ) 
DO 9 1=1,4 
DXC(I)=ALPHAC*S< I ) 

9 XC(I)=X(I)+OXC(I) 


DO 901 1=1,3 

901 VSV1< 1)=XC< I) 

CALL E C0MF( l TSTART^XU4NTEND,RSV0,VSV0,VSVI,RSE0,VSE0,RSM0,VSM0, 

1ERRM 
2SFM1 
3SM 

CALL bunwi 

1 VSVMMC , UV 1 C ,UVMC, UVFC , OUV I C, OUVMMC, OUVMPC , GC ) 
GCMAG=DS0RT(00T(GC,GC,4 > ) 

WRITE(6,116)FC,GC, GCMAG 
DO 902 1=1,4 

902 DGCm=GC< I )-G< I ) 



DO 91 1=1,3 
RSVMD( I ) = RSVMC( I ) 

VSVMPOII )=VSVMPC( I) 

DO 91 J = 1 » 3 

SFM11D(I,J)=SFM11C( ItJ) 

91 SFM120U, J) = SFM12C( I, J) 
CALL MXV { V »GC , RC ,4, 4 ) 

DO 92 1=1,4 

92 RC(I)=RC( I)-DXC(I) 
RCMAG=DSORT ( DOT ( RC,RC ,4)) 
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PC=D0T(DGC,RC,4) 

CALL VVT < RC , TEMPI , 4) 

DO 93 1*1,4 
DO 93 J = l,4 

93 VU,J)=VU,J)-TEMP1< l,J)/PC 
WRITE(6,117)DGC,PC»RC, RCMAG 
IF(FS.GT.F)GO TO 11 
IF(FC,GT.FS)GO TO 14 

10 DO 20 1=1,4 
X< I ) = XC ( I ) 

20 G ( I ) =GC ( 1 ) 

DO 201 1=1,3 
UV1 ( 1 ) =UVIC( I ) 

UVM( 1 )=UVMC< 1) 

DUVIt I )*DUVIC< I) 

DUVMMC I )=DUVMMC ( I ) 

DUVMP ( I ) =DUVMPC ( 1 ) 

RSVMD(I>=RSVMC< I) 

VSVMPO ( 1 ) »VSVMPC ( I) 

DO 201 J= 1 *3 

SFMUDt I , J)=SFM11C( 1,J) 

201 SFM12D( I, J1=SFM12C( I,J) 

F = FC 

GMAG=GCMAG 
GO TO 16 

11 IF(FC.LT.F)GO TO 10 

FC GRTHN F. REPEAT INTERPOLATION IN REDUCED INTERVAL. 
FS = FC 

ALPHA = AL PHAC 
DO 250 1=1,3 
XS( I ) = XC ( I ) 

GS ( I ) =GC ( I ) 

RSVMS1 I)=RSVMC( I ) 

VSVMPS( I)=VSVMPC(1) 

UV I S ( I >=UVIC< I ) 

UVMS ( I ) =UVMC < I ) 

DUV1S(I)=DUV1C( 1 ) 

DUVMMSI I)=OUVMMCU ) 

OUVMPS(n=DUVMPCU) 

00 250 J= 1 ,3 

SFM1 IS ( 1 ,J)=SFM11C( I,J) 

250 SFMI2S( I,J)=SFM12C(It J) 

SGS=D0T(S,GS,4) 

WRITE (6, 121) SGS 
GO TO 82 

13 IF( FS.GT.F)GO TO 15 

14 F=FS 
gmag=gsmag 

00 140 1=1,4 
XU) = XS(I) 

140 GU)=GSt 1) 

DO 141 1=1,3 
UVI( I)=UVIS( I) 

UVM( I ) =UVMS < I ) 

DUVI( I )=DUV I S { I ) 

OUVMH ( I )=DUVMMS< I ) 

DUVMP ( I ) =DUVMPS< 1 ) 
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RSVMD! I )«RSVM$( I ) 

VSVMPOU )-VSVMPS( I) 

DO 141 J= 1 , 3 

SFMllO! I ,J)=SFM11S! I*J) 

.'41 SFM12D(I,J)=$FM12S! I, J) 

15 CONTINUE 

16 DO 161 1 = 1,3 
RSVM! I)=RSVMD! I) 

VSVMP! I)=VSVMPDl I ) 

DO 161 J s x 9 3 

SFMl 1 ( I tJ)=SFMllD< I,J) 

161 SFM12C I»J)=SFM12D( 1*J) 

WRITE<6,118)X,F,GMAG, G, RSVMD, VSVMPD 
WRlTE(6tl07)(<V(ItJ)tJ=l,4>,I=l,4) 

IF ! GMAG.LT.EPS ) GO TO 18 
IFIITERO.LT* ITDMAXJGO TO 5 
WR I TE ( 6 ? 1 19 ) 

10 I P V s 1 

I PTRA J= 1 
IFILEbJFILEX 
WR I TE ( 6 , 1 20 ) 

GENERATE OPTIMAL TRAJECTORY ANO PRIMER VECTOR HISTORY 
DO 30 1=1*3 
pvoi n=uvi< n 

PVO( I + 3 ) = DUV 1(1) 

PVM ( I ) =UVM ( I) 

PVM ( 1 + 3 ) =DUVMP ( I ) 

30 VSVI(I)=X( I) 

CALL F0URBY!TSTART,X(4) ,RSVO,VSVI ,RSEO,VSEO, 

IRSMOtVSMOt PVO * RSVM , VSVMM, RSEM , VSEM ,RSMM t VSMM , SM I 11 f SMI 12 » 

2 SM I 2 1 , SM I 22 ) 

CALL F0URBY(X(4) , TEND, RSVM, VSVMP, RSEM,VSEM,RSMM, VSMM, 

1 PVM,RSVF, VSVF,RSEF,VSEF,RSMF, VSMF t SFM 1 1 ♦ SFM 12 1 SFM2 1 1 SFM22 > 

100 F OR MATC4 020*11) 

101 FORMAT (615) _ r . i _. , 

102 FORMATIlHOt 40X , * 4-BQDY 3-IMPULSE BOUNDARY VALUE PROBLEM'/ 

1 lHOt T8 » •GLlST28t»AUM'tT48 T •UTlMEST 68 »*UVELM» t T 88 f 'ERRMXM' , 
2T108, ' ERRMAX* /IH , 1P6D20 . 1 1 / 1H , T 8 , ' MS * t T28 , • ME ' , T48 , ' MM * / IH , 
31P3D20.il) 

103 FORMAT ( 1H , T8 ,» T START ' f T28 , * TM », T48 TEND »/ 1H , 1P3D20 . 1 1 / IH. , 
1T8, 'RSVO' f T68» • VSVO'/IH , 1P6D20.11/1H # T8 , • R SEO • » T68 , ' VSEO ' / 

21H tlP6D20.il/lH , T 8 , 1 R$MO • , T 68 , ' VSMO 1 /IH 9lP6D20.ll) 

104 FORMAT ClH0tT8, •VSVI' ^ 68 ,* VSVMP' /1H t 1P6D20 • 1 1 / IH , T 8 , • R SVT AR • , 
lT 68 f •VSVT.ARV1H , 1P6D20.11) 

105 FORMAT ( lH0tT8, 'KNR* »T28» ' ERRM IN ' ,T48,'FMINM',T68,*EPS , ,T88, 

1 • EPSV'/IH 1P5D20.11 ) 

106 FORMAT ( lHOtTSt 1 ICOMV* , T28, ' ITLMAX » , T48 t • I LINC ' *T 68 » 1 ITDMAX • tT 88 t 
1»1FILEX'/1H ,110,4120) 

107 FORMAT ( 1H0, T8, 'V'/IH , 1P6D20. 11/ 1H , 1P6D20. 1 1 / IH ,1P4D20.11) 
FORMAT ( 1H ,T8, * F • ,T28, 'G* ,T108, 'GMAG'/IH , 1P6D20.11) 

FORMAT! 1H1,T8, MTERD'/IH ,110) 

FORMAT (1H0,T8» 'S' ,T 88 f’SG*/lH ,1P5D20.11) _ _ , 

FORMAT ( 1H0,T8, * SIGNS OF S AND SG REVERSED * / IH , T 8 , ' S ' , T 88 , 1 SG ' / 

11H , 1P5D20.11) 

OX' ,T88, 1 ALPHA ' /IH , 1 P5D20. 1 1 / IH , T8 , 1 XS • / IH , 


108 

109 

110 
111 


112 FORMAT! 1H0,T8, 

1 1 1 H , 1 P4D20 .11) 

113 FORMAT! IH , T8, • FS * , T28, • GS S T 108 , 'GSMAG • / IH ,lP6D20.n> 
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114 FORMAT (1H fT8 t »DG I f TB8» 'P* *T108, 1 SGS'/IH t lP6D20.il / 1H f T8t 

1 ' R ' * T88 * ' RMAG • / 1H ,lP5020.m TQ 

115 FORMAT! lH0»T8t 'CUBIC INTERPOLATION BETWEEN X AND XS'/lH0tT8t 
""** , l*DXCST88 t 'ALPHAC'/IH , 1 P5D20 . 1 1 / IN ,T8,'XC'/1H ,1P4020.11) 


9 T 8 


' FC ' ? T28t ' 


GC * * T 108 * 'GCMAG' /1H ♦ 1P6D20.11) 
PC'/IH f 1P5D20.11/1H ,TS,*RC'tT88, 


AJt 6 FORMAT ( 1H 

117 FORMATtlN * T 8 , • DGC • t T 88 , 

l'RCMAG'/lH f 1P5D20. 1 1 ) • . _ 

118 FORMAT! lH0,T8 t 'OUTPUT OF THIS I TER AT I ON ' / 1H0 T T8 , X ,T88, F T 
IT 108f 1 GMAG 1 /1H tlP6D20.il/lH f T8t'G'/lH , 1P4D20 . 1 1 / 1H *T8f 

2'RSVMD* ,T68t ' VSVMPD' /1H ,1P6D20.11) _ ma v ?miimi i 

119 FORMAT ( lH0tT8t 'NO* OF 0AV1D0N ITERATIONS HAS REACHED MAXIMUM' 

FORMAT ( 1H1 ) 

FORMAT ( IHOtTSf ' SGS* / IH t IP 1020 ♦ 11 ) cr4icn QV cocun 

FORMAT! IHOtTQ*' RESTART WITH IDENTITY V MATRIX SCALED BY EPSV I 

RETURN 
END 


120 

121 

122 
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c 

c 

c 

q 


OPTIMAL 3-IMPULSE TRANSFER FROM A 
GIVEN FINAL POSITION ANO VELOCITY 


GIVEN 

IN 


190 


200 

i 


PROGRAM PTP3I3 
PROGRAM COMPUTES FUEL 
INITIAL POSITION TO A 
FIXED TIME. 

IMPLICIT REAL*8( A-H,K-M,0-Z) • ■■■ t 

DIMENSION X<4)*G<4>*Vt4*4>,XS(4>,GS(4>*RC4)*0X(4> ,REV0(3) * 

IVEVOt 3) * REMO ( 3 ) * VEMO (3 I * VEVOP ( 3 ) ? TEMP 1 ( 4*4),SFM11S<3,3), 

2SFM12S (3*3) v SFM2 1 S ( 3 , 3 ) * SFM2 2 S ( 3 * 3 > , SM 1 11 S ( 3 * 3 ) *SMI12S(3*3), 

3SMI21SI 3,3),SMI22S(3*3)*REVM(3)*VEVMP(3),REVMS(3) ,VEVMPS(3), 

4DUV 1 S ( 3 > t OUVMMSI 3 ) *DUVMP $ ( 3 ) *DG ( 4 ) *VS( 4,4 ) *DXC(4) *XC(4) 

5REVMC(3),VEVMPC(3),UVIC(3),UVMC(3)tUVFC( 3) »DUVIC{3 ,DUVMMC 3) t 

6DUVMPC ( 3 ) * RC ( 4 ) * $M 1 1 1C ( 3 * 3 ) * SM I 12C(3*3> * SMI 2 1C (3,3) * SMI 22C ( 3 *3 ) t 

7SFM1 1C ( 3* 3 ) * SFM-12C ( 3* 3 ) * SFM2 1C ( 3 * 3 ) * SFM22C ( 3*3 ) *REVMD ( 3 j * 

8 VEVMPO ( 3 ) »UV I S ( 3 I *UVMS( 3 ) *UVF S ( 3 ) * S ( 4 > * SFM 1 1 ( 3 * 3 ) * SFM12 ( 3 * 3 > * 

9SFM21<3*3)*SFM22(3*3) *UVI ( 3)*UVM(3),UVF(3) ,DUVI (3) *pUVMM(3> * 
1DUVMP.I 3 1 * SMI 11(3*3) *SMl 121 3*3) *SM121( 3*3) *SM122(3*3)*PyO(6 ) , 

2PVM(3),REVTAR(3I *VEVTAR( 3) tSFM110( 3*3 ) * $FM 1 20 ( 3 * 3 ) * OGC ( 4} * 

3 VC (4*4) * GC ( 4 ) »VEVMM( 31 *REMM( 3) * VEMM( 3 ) *REVF ( 3 ) ,VEVF (3) *R6MF( 3) * 

4VEMF { 3 ) * VE VMMS ( 3 ) * VEVMMC ( 3 ) t 

COMMON/CONST 3 /ME *MM , GAMMA *UOM *UT I ME *UVELM * ERRM AX *DTR 
COMMON/ FLAG/ I MTX* IPV* IPTRAJ* I PVTM* I F I LE * I TER* I TAR 
READ(5*100) GAMMA *UDM*UT 1 ME *UV ELM 
READ(5* 100)ME*MM 
READ! 5*100 >T ST ART *TM, TEND 
READ! 5* 100) REMO* VEMO 

READ(5,100)REV0*VEV0 - > 

‘ READ15* 100)VEV0P*VEVMP 
READ( 5,100)REVTAR»VEVTAR 
READ( 5* lOOKNR* ERRM IN * ERRMXM 
READ(5,100)FM1NM*EPS,EPSV 

REA0(5* 101 ) ICOMV, ITLMAX* 1L INC* ITOMAX* IF ILEX 
I F ( ICOMV.GT .0) GO TO 190 

OPTION TO INPUT VARIANCE MATR 1 X ( 1 COMV-O ) 

READ! 5 * 100 M < V ( I * J ) * J* 1 *4 ) , 1 = 1*4) 

GO TO 1 
DO 200 1=1*4 
DO 200 J= 1 * 4 
V( I*J)=0. 

IFC I.EO.J)V( I, J)=1.0 
CONTINUE 

DTR=1. 74532925 19943296D-2 

errmax^errmxm/udm 

FMIN=FMINM*UVELM 
KNRSAV=KNR 

WRITE(6*102 )GAMMA*UDM*UTIME * UVELM * ERRMXM * ERRM AX *ME *MM 
WRITE! 6* 103 )TST ART, TM* TEND, REVO* VEVOtREMO* VEMO 
WRITE! 6, 104) VEVOP , VE VMP *REVTAR * VEVTAR 

WRITEI 6*105)KNR,ERRMIN*FMINM* EPS*EPSV 
WRITE (6* 106) ICOMV, ITLMAX* I LINC*ITDMAX, IF ILEX 
1 PV=0 
I PVTM=0 
I F I L E = 0 

1 PTRA J =0 

IMTX= 1 
I TER0=0 
DO 2 1=1*3 
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c 


c 


c 


2 xm=VEVOfM n 

X( 4)=TM 

COMPUTE INITIAL NOMINAL TRAJECTORY 

CALL COMF3(TSTART,TM,TEND,REVO, VEVO,VEVOP,REMO,VEM0,ERRMIN, 
llLlNCtKNRSAV, ITERD, I TLMAX ,REVMO , VEVMPD ,REVTAR , VEVTAR , SFM1 ID, 
2SFM12D,REVM,VEVMM,VEVMP,F,UVI ,UVM,UVF, SMI 11, SMI 12, SMI 21 , SMI 22, 
3SFM11,SFM12,SFM21,SFM22) _ 4 

CALL COMGISMI 11 , SM II 2 , SM 1 2 1 , SMI 22 , SFM1 1 , SFM1 2 , VEVMP , VEVMM , UV I , 
IUVM ,UVF , DUV I , DU VMM , DUVMP ,G ) 

GMAG=OSORT(DOT(G,G,4n 
WRITE(6,108)F,G,GMAG 
DO 3 1=1,3 
RE VMD( I ) =RE VM l I ) 

VEVMPDI I ) =VEVMP ( I ) 

DO 3 J = 1 ,3 

SFM11DI I,J)=SFM11( I,J> 

3 SFM12DU , J)=$FM12( 1 , J) 

IF( I COMV# EO« 0 ) GO TO 40 

OPTION TO COMPUTE TRIAL VARIANCE MATRIX UC0MV=1) 

DO 4 1=1,4 
DO 4 J=1 ,4 

V( I,J)*VC I, J)*EPSV/GMAG 

4 CONTINUE 

40 WRITE(6,107)( ( V ( I , J ) ,,J® 1,4), 1 = 1,4) 

ACCELERATED GRADIENT ITERATION LOOP 

5 I TERD= I TERD+ 1 
WRITE(6,109) ITERD 
CALL MXV( V,G,S,4,4) 

DO 50 1=1,4 

|50 S< I )*-S ( I ) 

SG=00T(S,G,4) 

WRITE(6,110)S,SG 
I F ( SG *LT .0 • ) GO TO 51 
DO 52 1=1,4 
52 S(I)=-S( I) 

SG=-SG 

WRITEI6,111)S,SG 
51 AL P= ( FM IN— F > / SG 

ALPHA = DM1N1U.0D+0,ALP) 

6 DO 61 1=1,4 

DX( 1 ) =AL PHA*S ( I ) 

6i xs(i)*xm*oxm 
DO 62 1=1,3 


62 


"01 



GSMAG=DSORT(DOT(GS,GS,4) ) 
WRITE ( 6 , 113)FS,GS,GSMAG 
DO 701 1=1,4 
DGI I )=GS( I >-GI I ) 


DO 7 1=1,3 
REVMDl I)=REVMS( I) 


, 
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8 


81 

82 


VE VMPD( I > =VE VMPS ( 1) 

00 7 J = l,3 

SFM11D( It J)*SFMlISMf J) 

7 SFM12D( I , J)*SFM12S( I ,J > 

CALL MXV( V*DG,R,4,4) 

00 71 1*1,4 
71 R ( I ) = R ( n-DX( I) 

RMAG=DSQRT ( DOT ( R »R,4 > ) 

P=DOT ( OG, R, 4 ) 

PMAG = DABS< P> 

SGS=DQT(S,GS,4> 

WRITE(6,il4)DG,P,SGS ,R, RMAG 
CALL VVT< R, TEMPI, 4) 

DO 81 1*1,4 
DO 81 J= 1 , 4 

V II, J ) =V C1,J1 -TEMPI (1,J)/P 
I F < SGS • GT • 0. ) GO TO 83 
I F ( FS .LT «F ) GO TO 14 
ALPHA=ALPHA/10.0 
IF( ALPHA. LT.ALPMINIGO TO 84 
GO TO 6 

84 DO 840 1*1,4 

DO 840 J = 1 , 4 «.■ 

V ( 1 , J ) *0 • 

IF< I.EQ.J)V( 

840 VUf Jj*ycif J)*EPSV/GMAG 
WRITE! 6, 122) 

GO TO 40 

83 CONTINUE *- 

CUBIC INTERPOLATION BETWEEN X AND XS 
Z=3.^(F-FS)/ALPHA+SG+SGS 
W2* Z*Z-SG*SGS 
IF( W2.LE.0. )G0 TO 13 

ALPHAC= ALPHA*! l.-( SGS+W-Z ) / ( SGS-SG+2 .*W ) ) 

DO 9 1=1,4 
DXCII ) = ALPHAC*Sm 
9 XCt I > = X ( I ) +DXC ( I ) 

DO 901 1=1,3 
901 VEVOPU)=XC(n 

CAU E C0MF3 l aST X A^txC^;^END,REV0,VEV0,VeV0P,REM0,VEM0,ERRMlN, 

I II INC,KNRSAV, ITERD, I TLMAX , REVMD, VEVMPD , RE VT AR , VE V TAR » SFM1 ID, 
2SFM12D,REVMC,VEVMMC,VEVMPC,FC ,UVIC,UVMC,UVFC,SMI11C,SMI 12C, 
oir . T ? ?f « 9FM1 1C , SFM12C , SFM21C, SFM22C ) 

CALL %mG(SM111C,SM112C,SMI21C,5MI22C,SFM11C,SFM12C,VEVMPC, 

1 VEVMMC, UV I C , UVMC , UVFC , OUV I C , DUVMMC , DUVMPC* GC ) 

GCMAG=DSQRT< DOT! GC,GC,4) ) 

WR ITE ( 6 , 1 16 ) FC , GC, GCM AG 
DO 902 1=1,4 
902 DGC ( I )=GC( I )-G( I ) 

DO 91 1=1,3 
REVMD ( I ) = REVMC < I ) 

VEVMPDl 1 ) =VEVM PC ( I > 

DO 91 J=l,3 

SFM11DU,J) = SFM11C(I,J) 

91 SFM12D( I , J ) = SFM12C< I , J ) 
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CALL MXV(V,GC,RC,4,4) 

00 92 1=1,4 

92 RC< n=RC( I1-0XC< I ) 

RCMAG=DSQRT(D0T(RC,RC,4) ) 

PC*D0T<DGC,RC,4) 

CALL VVT( RC, TEMPI, 4) 

DO 93 1=1,4 
00 93 J= 1 , 4 

93 V ( I , J ) =V ( I, J.) -TEMPI! I,J)/PC 
WRITE! 6, 1 17 ) DGC » PC , RC , RCMAG 
1F(FS.GT.F)G0 TO 11 

IF ( FC.GT, FS ) GO TO 14 

10 00 20 1=1,4 
X( I ) = XC ( I ) 

20 G( I)=GCt I) 

DO 201 1=1,3 
uvn n=uvict i) 

UVM< I )=UVMC( I ) 

DUV1 ( 1 ) = DUVIC( I ) 

DU VMM ( I ) = DUVMMC Cl ) 

DUVMPt U=DUVMPC( I ) 

REVHD( I J = REVMC( I 1 
VE VMPD ( I 1= VE VMPC ( I) 

DO 201 J= 1 * 3 

SFHllDt I ,J)*SFM11CC I,J) 

201 SFM12D1 I, J)=SFM12C(I,J) 

F = FC 

GMAG=GCMAG 
GO TO 16 

11 IF ( FC • L T ♦ F ) GO TO 10 

FC GRTHN F « REPEAT INTERPOLATION IN REDUCED INTERVAL 
FS = FC 

ALPHA = AL PHAC 
DO 250 1=1,3 

xsm-xcm 

GS(I) = GCm 
REVMS ( 1 ) =REVMC ( I ) 

VEVMPSI 1 )=VEVMPC(I) 
uvisu )«uvicm 
UVMS(I)=UVMC( I) 

Duvism=Duvicm 
OUVMMSt I)*OUVMMCm 
DUVMPSH )=DUVMPC( I ) 

DO 250 J = 1 , 3 : 

SFHllSIIf J)«SFH11CC I »J> 

250 SFM12SI I, J)*SFM12C( I, J) 

SGS=DOT ( S , GS ,4 ) 

WR I TE ( 6 , 1 2 1 ) SGS 
GO TO 82 

13 I F ( FS*GT* F )G0 TO 15 

14 F =FS 

GMAG=GSMAG 

00 140 1=1,4 
X ( 1 > = XSt I) 

40 G ( I ) =GS( I) 

DO 141 1=1,3 

uvn n=uvis( n 


UVM ( | )=UVMS( n 
DUV1 ( I) = DUV IS( 1 ) 

OUVMM( I l = DUVMMS ( 1 ) 

OUVKPt I )=DUVMPS1 I ) 

REVMD ( I ) = REVM 5 ( I ) 

VEVMRDI I ) »VE VMPS l I ) 

DO 141 J= 1 1 3 

SFM11DU ,J) = SFM11SU r J) 

141 SFM12D1 I,J)=SFM12S( 1, J> 

15 CONTINUE 

16 DO 162 1 = 1,3 

RE VM( I ) =RE VMD ( 1) 

VEVMP( I )=VEVMPDt 1 ) 

DO 161 J = 1 , 3 
$FMll(l t J)“SFMllD< I,J) 

161 SFM12U, J)=$FM12DU,J) 

WRITE l 6,118)X,F,G,GMAG, RE VMD, VEVMPD 
WRITE(6,107) ( ( V( I ,J) *J«lt4) ,1=1,4) 

IF ( GMAG.LT.EPSJGO TO 18 
1FUTERD.LT. ITDMAXIGO TO 5 
WR I TE I 6 1 1 19 ) 

18 IPV=1 
I PTR A J= 1 
IFILE=IFILEX 

GENERATE ^OPTIMAL TRAJECTORY AND PRIMER VECTOR HISTORY 

DO 30 1=1,3 
PVOt I)=UVI< I) 

PVO( 1 + 3 ) = DUV I C I > 

I PVM ( I > =UVM ( 1 ) 

PVMU+3) = DUVMP( I ) 

30 j START?x ( t REVO, VEVOP, REM0,VEM0,PV0,REVM,VEVMM, 

1REMM, VEMM , SM 111, SM 112, SM 121, SMI 22) 

CALL THRBDYt X(4 ) , T END, REVM , VE VMP ,REMM , VEMM , PVM»REVF , VE VF , REMF f 
i VEMF t SFM1 1 1 SFM12 , SFM21 ♦ SFM22 ) 

100 FORMAT ('4 D20.ll) 

102 FORMAT< IHoUoX, '3-BOOY 3-IMPULSE BOUNDARY VALUE PROBLEM'/ 

1 1H0*T8, • GAMMA* ,T28, ' UDM* ,T48, 1 UT I ME 1 , T68 , 1 UVELM ' ,T88 , ERRMXM , 
2T108UERRMAX,/; H ,1p 6D20. 11/1H U8, ' ME • ,T28 , • MM* / 1H , iP2D20. 1 1 ) 

103 FORMAT ( 1H y T 8 , » T START • ,T2 8 , ' TM « ,T4B , * TEND » / 1H , 1P3020 


tlP6D20.il/lH ,T8, ‘REMO* ,T68, 


11/ 1H , 
V EMO * / 


1T0, *REVO* ,T68,» VEVO'/IH 

104^ FORMAT [ 1H0,T8, * VEVOP ' , T68 , ' VEVMP • / 1H tlP6D20.il/iH ,T8, 'REVTAR' 
1T68, *V6VTAR*/1H tlP6D20.ll) 

105 FORMAT ( 1H0, T8, • KNR ' ,T28, • ERRM1N* ,T48, 'FMINM* ,T68 f *EPS' ,T88, 

106%OBMAt{iHO , ,T8^ICOMv'',T28, • 1TLMAX • , T48 , ■ I L INC ' ,T68 , • I TDMAX ■ ,TB8 
1 *IFILEX'/1H ,110,4120) „ , 

lfl7 FORMAT ( 1H0,T8,*V*/1H , 1P6D20. 1 1 / 1H tlP6D20.il/lH tlP4D20.ll) 
fSShATUH ,TbI'F»,T 28,«GST108,*GMA6'/1H ,1P6020.1H 
F0RMAT(lHltT8,UTERD»/lH ,110) 

FORMAT ( lHOtTB , ' S* *T88, * SG '/ 1H , 1P5D20. 11 ) 

F0RMATUH0,T8, • SIGNS OF S AND SG REVERSED* /1H ,T8,«S« ,T88, SG / 
112^ FORMAT U HO t T8, , 0X' , T 88 , ' ALPHA* /1H , 1 P5D20. 1 1 / 1H , T8 , ' X S • / 1H , 


108 

109 

no 

tii 


1 1 H , 1P4D20.11 ) • „ , , % 

113 FORMAT! 1H t T8» » FS* »T28» f GS* »T108 * •GSMAG # /1H *1 P6D 20*11 ) 

114 FORMAT ( 1 H * T 8 ♦ • DG 1 t T88 ♦ ' P * * T 108 * ■ SGS ' / 1H , 1 P6D20 . 1 1 / 1H » T8 t 

“l 1»RST88,'RMAG*/1H , 1P5D20.11) . v ._ in vCI/lUn TR 

n5 FORMAT ( 1H0*T8* ’CUBIC INTERPOLATION BETWEEN X AND /lHOt ^ 

1 1 DXC ' t T88 ♦ 1 ALPHAC * /1H rlP5D20.il/lH * T8 ♦ * XC 1 / 1H t 1P4D20* 1 1 

116 FORMAT ( 1H ,TB, *FC* t T28, »GC* »T108t 'GCMAG' /1H » 1P ^20#11) 

117 FORMAT ( 1H * T8» * OGC * *T 88* • PC * / 1H , 1 P5D20. 1 1 / 1H ,T8 t RG »>88t 

1 * RCMAG 1 / 1H f 1P5020.11) A • »> # too I Cl 

118 FORMAT! 1H0.T8, 'OUTPUT OF THIS ITERATION VIHO.TB, X .TBS, t 
IT 108 * * GMAG* / 1H , 1P6020 . 1 1 / 1H , T8 > • REVMD ' ,T68 , • VEVMPD / 1H , 

119 Z FORHATuio,TB,'NO. OF OAV 1 DON ITERATIONS HAS ' REACHED MAXIMUM* > 

120 FORMAT ( 1H1) 

121 FORMATS 1H0 »T 8 » 1 SGS 1 / 1H f lPlD20.11) ■ . CC v « Y FPSVM 

122 FORMAT( 1H0,T8, 'RESTART WITH IDENTITY V MATRIX SCALED BY EPSV ) 


RETURN 

END 
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v y n=Kivui 1 

v ( n=vsvo< 1 1 
E ( I ) = RSEO ( 1) 
E ( l)sVSEO(l) 
M ( I )=RSMO( I ) 
*U I)=VSMO( I ) 


: YTn 


MSME=MS+ME 

msmm=ms+mm 

MEMM=ME+MM 

ESE=ME/M$ME 

MSMsMM/MSMM 

MEM=MM/MEMM 

EEM=ME/MEMM 

SSE~MS/MSME 

SSM=MS/MSMM 

PSISV=0. 

PSI SE=0# 

PS I SM = 0 • 

PS 1 EV = 0* 


PSI MV=0 • 

PSIEM=0. - 

LM=0. 

CALL RVEMVI RSV, VSV ,RSE*VSE, RSM, VSM,REV, VEV,RMV»VMV,REM, VEM) 

IF ( IMTX.EQ.O) GO TO 2 


DO 2 1=1,6 
PV(1)=0. 

00 2 J= 1,6 
STMt I » J ) =0 • 

IF(I.EO.J) STM(I,J)=1.0 
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2 CONTINUE 
I STE P=o 
T*XTO 
TGOsXTF-T 

CALL C STEP ( TGO * RSV , REV , RMV , RSE ?R SM ,REM, H *DR4RSV ,DR4R SE , 

1DR4RSM, BIGJ) 

CALL DISP 

! F ( IPV.EQ.O) GO TO 21 
LTM=1. 

TTM= XTO 

CALL PVECCT, RSV , V SV , PVO , STM , PV , LM , LDM > 

21 IFMF1LE.EO.O) GO TO 22 
CALL FDATA 

22 I F { I PTR A J • EQ. 0 ) GO TO 3 
WR I TE I 6, 100 ) 

I F ( IPV.EO.O) GO TO 23 
WR ITE(6,101) 

23 CALL PTRAJ 

3 I STE P= 1 STE P+ 1 

CALL TWOBOY(RSV»VSV f H»MS»PSlSVf IMTXfCRSVtCVSVfMTXSV) 

CALL TWOBDY( RSE,VSE tH,MSME,PSI SE,0,CRSE,CVSE,MTXSE) 

CALL TWOBOYC RSM , VSM, H , MSMM, P S I SM , 0 » CR SM , CVSM , MTX SM ) 

CALL TWOBDY( REV f VEVfH f ME*PSIEVr IMTXfCREVfCVEVr^TXEV) 

CALL TWOBDY ( RMV , VMV, H , MM , P S IMV, I MTX , CRMV t CVMV »MTXMV ) 

CALL TWOBDY( REM,VEM,H,MEMM,PSIEM,0,CREM,CVEM t MTXEM) 

DO 4 1=1,3 

DRSV ( I )=CRSV< I )-RSV ( 1)-M*VSV( 1 ) 

DVSV ( I ) =CVSV ( I )-VSV( I ) 

DRSE ( I )=CRSE( I)-RSE( I ) -H*VSE ( I ) 

1 OVSE( I )=CVSE( 1 )~VSE( I ) 

ORSM ( I )=CRSM< I )-RSM( I )-H*VSM(I ) 

DVSM( I)*CVSM( I)-VSM( I) 

OREV{I)=CREV( I)-REVU)-H*VEVni 
DVEV ( I ) =CVEV( I ) -VEVC I ) 

DRMV { I)=CRMV( ! >-RMV( 1 )-H*VMV.( I ) 

DVMV< I)*CVMVI I)~VMV< I ) 

DREM ( I )=CREM( I)-REM( 1 >-H*VEM( I ) 

DVEMI n=CVEMU)-VEM(I) 

PRSV( 1 ) = ESE*DRSE ( D+DREVl I >+MSM*DRSM( I J+DRMVI I ) 

PVSV( 1 )=ESE*DVSE( I I + DVEVU )+MSM*DVSMm+DVMVU) 

PRSE< I }=MSM*DRSM( I ) -MEM*DREM ( I ) 

PVSE( I ) =MSM*DVSM( I 1-MEM*DVEM( I) 

PRSM(I) = ESE*DRSEt n+EEM*DREMU) 

PVSMC I)-ESE*DVSE( I) + EEM*DVEM( I) 

RSV ( I ) =C RSV ( I ) +PRSV ( 1 ) 

vsv( i ) = cvsv( i ) + pvsvu> 

RSE(IXRSE( D+PRSEU) 

VSE( I) = CVSE( I) + PVSE(I) 

RSM( I)=CRSM( 1 ) +PRSM ( I ) 

4 VSMU >=CVSMm+PVSM(I> 

CALL RVEMV ( RSV , V SV , R SE , VSE , RSM , VSM ,REV , V EV ,RMV , VMV ,REM , VEM ) 

T-f H 

CALL DELRVt H,RSV,REV,RMV,RSE,RSM,REM,CRSV,CREV,CRMV,CRSE,CRSM, 
1CREM,DR4RSV,DR4RSE,DR4RSM,RRSV,RVSV,RRSE,RVSE,RRSM,RVSM> 

DO 5 1=1,3 

RSV ( I )=RSV( I ) +RRSV ( I ) 

VSV( I ) =V SV( I )+RVSV ( I ) 
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7 

70 


71 

72 


RSE( I }~RSE< D+RRSEt I ) 

VSE< l)»VSECl)+RVSE< I) 

RSM( I)=RSMU >+RRSM( I» 

CALl'rVEMVIRSV^VSvIrSEiVSE.RSM.VSM.REV.VEV.RMV.VMV.REM.VEM) 

I F ( IMTX.E0.0) GO TO 70 
DO 6 1=1,6 

STMH(l°J)-HTXSVt I»J-)+MTXEV( I,J)+MTXMV(i,J).-Z.O'*BlGJ»I,J) 

CALL MXM<STMH,STM,TEMP,6,6,6) 

DO 7 ) = 1,6 
DO 7 J=l,6 
STM( I, J )=TEMP( 1,J) 

CALL 01SP 

IF(1PV*EQ*0) GO TO 71 

CALL PVEC(T,RSV,VSV ,PVO,STM,PV,LM,LDM) 

IF< IFILE.EO.O) GO TO 72 
CALL FDATA 

IF ( IPTRAJ.EO.O) GO TO 8 
CALL PTRAJ 

( T*GE* XTF ) GO 


8 IF 


TO 9 


CALL CSTEP(TG0,RSV,REV,RMV,RSE,RSM,REM,H,DR4RSV,DR4RSE, 

1DR4RSM* B IGJ ) 

GO TO 3 

9 DO 10 1=1,3 
RSVDl 1 )=RSV( n 
VSVO(I)=VSV( I) 

RSED(1)=RSE(I) 

VSED ( I ) -VSE ( I ) 

RSMD( 1 )=RSM( I) 

VSMD( I )=VSMt I ) 

00 10 J- 1 , 3 
SU(1,J)=STM(1,J) 

Sl2U,J) = STMU,J + 3> 

S 2 H 1 , J ) - ST M ( 1 + 3 , J ) 

10 S22U, J )*STM( 1+3, J+3) 

IF( IPV.EQ.O) GO TO 11 
IF( 1PVTM-.E0.0) GO TO 11 

WR1TE(6,102)TTM,LTM,LOTM,RTM,VTM 

11 IF ( I PTRAJ. EC* 0) GO TO 12 
WRI TE { 6, 103 ) I STEP 


61H f lb»'KUUU’,iDor vuliu ' *'■ 

61H0,T8, •RDLID* ,T68, * VDL1D* /1H 

_ 7 cnp MAT^M h' ’ 78. • PV* ,T68, *PVD* /1H ,T8, • PVMAG' ,T28 , • PVDMAG • ) 
pnRMAT lHo’^TIME OF MAXIMUM PRIMER VECTOR M AGN I TUDE • /1H0 , T8 , 
10 %TtM%T 2 8?. L Tm",T°8,.LDTM./1H , 1P3D20.U/1H , T8 , • RTM • , T68 , • V 

2/1H , 1P6D20 *11) # 

103 FORMAT! 1H0,T8, • 1STEP FOR THIS LEG = ,15) 
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RETURN 

END 



i 


•j 

i 




, REVO, VEVO, REMO, VEMO,PVO,REVD,VEVD, 
) 



l\L V t I I ~T\l- V V t * I 

VEVd ) = VE VO C I ) 

REM( I)=REMOlI> 

VEM( I )=VEM0t IT 
RMV ( I ) =— REM ( I ) +REV ( I ) 

VMV ( 1 )=-VEM( I )+VEV( I) 

TO=XTO 
MEMM=ME+MM 
MEM=MM/MEMM 
PS I EV-0 * 

PSIEM^O. 

PS I MV«0 • 

LM = 0. 

LDM=0. 

I F ( 1MTX. EQ. 0 ) GO TO 2 
DO 2 1=1,6 
pvm=o. 

DO 2 J=l,6 
STM( I, J>=0. 

IF! I.EO. J)STMU,J)*1*0 
CONTINUE 
I STE P=0 
T = XTO 

CALL CSTEP3T TGO, REV ,RMV ,REM,H, DR4REV , 

CALL OISP3 
IF! IPV.EO.O) GO TO 21 

LTMsl.O 

ffM^XTO 

CALL PVEC(T,REV,VEVf PVO , STM, PV , LM, LDM ) 

IF( IFILE.EQ.O) GO TO 22 
CALL FDATA3 o 

* iFi IPTRAJ.EO.O) GO TO 3 

WR I TE ( 6 , 100 ) 

IF! IPV.EO.O) GO TO 23 
WRITE! 6,101) 
i CALL PTRAJ3 

J C ALL ^TWOBDY^RE V ? VEV »HtMEtPSlEVt IMTX »CRE V » CVEVf MTXE V ) 
CALL TWOBOVlREMfVEM, H, MEMM, PS I EM , 0, CREM , CVEM,MTXEM ) 


0 1 G J ) 
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CALL TWO BOY ( RMV, VMV »H,MM, PS 1MV * I MTX »CRMV »CVMV , MTXMV ) 
DO A 1=1,3 

DRMVU )=CRMVU )-RMV( I )-H*VMVU) 

DVMV ( I )*CVMV( I )-VMV ( I ) 

PREVt l) = ORMV( I > 

PVE V ( I ) =DVMV ( I ) 

REV( I ) =CREV ( I ) +PREV ( I ) . , 

VEVU )-CVEV< n + PVEV< I ) 

REM{ I ) =CREM( 1 > 

VEM( 1)«CVEM( I ) 

RMV ( I ) =-REM ( I ) + REV ( I) 

4 VMV(I)=~VEMU )+VEV<I > 

T ” T+ H 

CALL DELRV3(H,REV,RMV,CREV,CRMV,DR4REV,RREV,RVEV) 

DO 5 1=1,3 

REV ( I ) = RE V ( I >+RRE Vi I) 

VEVU >=VEVC I ) + RVEV( I) 

RMV ( 1 )=-REM( I )+REV < I) 

5 VMV ( 1 ) =-VEM( 1 ) +VEV ( I ) 

I F ( 1MTX.EG.O) GO TO 70 
DO 6 1=1,6 

6 STMHI I ,j)=MTXEV( 1 , J ) +MTXMV( I , J ) -2 . 0*BI G J ( I ,J> 

CALL MXM<$TMH,STM,TEMP,6,6,6) 

DO 7 1=1,6 
DO 7 J= 1 * 6 

7 STM( I,J)=TEMP< I,J> 

70 CALL D1SP3 

1 F ( 1 P V . E Q # 0 ) GO TO 71 

CALL PVEC(T,REV,VEV,PVO,STM,PV,LM,LDM) 

71 1F( IFILE.EQ.O) GO TO 72 
CALL FDATA3 

72 IFUPTRAJ.EO.O ) GO TO 8 
CALL PTRAJ3 

8 IFU.GE.XTF) GO TO 9 
TGO = XTF-T 

CALL CSTEP3 ( TGO, REV ,RMV ,REM ,H » DR4REV ,B IG J ) 

GO TO 3 

9 DO 10 1=1,3 

RE VD( I ) =REV ( I ) 

V EVD ( 1 ) =VE V ( I ) 

REMDI 1 )=REM( I ) 

VEMD( n=VEMU) 

DO 10 J = 1 1 3 

Slic I,J)=STM(I,J> 

s 1 2 C 1 ,4 ) = STM( I, J+3) 

S21 ( ! » J) =STM( 1+3 ,J) 

10 S2 2 < I * J )=STM( 1+3, J+ 3 ) 

IF ( IPV.EO.O) GO TO 11 
IFUPVTM.EO.OI GO TO 11 

WRITE ( 6, 102 )TTM,LTM,LDTM,RTM,VTM 

11 IF ( I PTRAJ.EO.O) GO TO 12 
WRITE(6,103) ISTEP 


100 FORMAT UH1 ,40X, • THREE-BODY TRAJECTORY < /1H0 ,T8 , • J ’ -^S^TDAY 
1T ,n i h i • T 68 • *REVMAG* ,T88, * RMVMAG * / 1H ,T8,'REV ,T68, VEV / 
21^;T8,IrRV^T68,-VMV'/1H ,T8, • REM • , T68 , • VEM • / 1H ,T8,.REL1' 



* 



170 



3T68f 1 VEL 1 • /lHOt f 8t • RDVD* ♦ T68* • VOVD* /1H *T8 t 1 ROEO ' ,T68 , • VOED| / 
41H fT8* , R0LD'»T68t 1 VOLD* /1H ,T 8 , 1 ANGV * , T 28 , • ANGE » , T*8 , • ANGMM 
101 FORMAT ( lHO,TR t «PV» »T68» , PVD , /1H ,T8 » • PVMAG * »T28, * ™|>MAG > 

12 FORMAT ( 1H0 ? T 8 t •TIME OF MAXIMUM PR I MER SECTOR ^tr^TM^ ' T68 , 

1 T8 t 1 TTM» , T28, 1 LTM» iT48 t 1 LOTM 1 / 1H , 1P3D20. 1 1 / 1H »T8* RT t 

2 * VTM * / 1H , 1P6D20.11) ^ , , * . 

103 FORMAT! lHO t T8, * I STEP FOR THIS LEG V * I5) 

RETURN 

END 
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SUBROUTINE 7WOBDY { 


AlSU'f AVU 


GENERAL SOLUTION OF TWO BODY PROBLEM WITH PARTIAL DERIVATIVES 
RTRAN DOUBLE PRECISION SUBROUTINE ___ 

DOUBLE PRECISION SOI 6 ) , TAU,MU,PSI t S ( 6 ) , P ( 6 , 6 ) , P I ( 6 , 6 ) * ACC ( 3 ) , 

lACCO(3)fR,ROrSIGOtALPHAfPSIN»PSIPtAtAPtCO,CItC2, 

2C3,C4,C5X3, $1, S2, $3,DTAU,DTAUN,DTAUP,U,FM1 ,G,FD,GDM1 

DOUBLE PRECISION XRO ( 3 ) , X VO ( 3 > v XRF t 3 ) , XVF ( 3 > 

SOI 1 ) , SO(2 ) » SO( 3) »X0* YOtZO=POSIT ION COMPONENTS AT REFERENCE T^E ™ _ 
S0(4),S0(5),S0(6)=XD0,YD0, ZDO=VELOCI TY COMPONENTS AT REFERENCE TIME TO 
TAU=TIME INTERVAL IT-TO) FROM REFERENCE TIME TO TO SOLUTION TIME T 
MU=CONST ANT IN DI FF . EOS. ( XOD, YDD, ZDD) =-MU* I X , Y , Z ) / ( R^3) ^ 

PS I =APPROX IMAT ION FOR FINAL SOLUTION PSI OF KEPLER S EQUATION 

PST = GENERALIZED S ECCENTRIC ANOMALY* SOLUT I ON OF KEPLER'S ^ ® T I. . 

S(l>,S(2),S(3>*X*Y t Z=POSITION COMPONENTS AT SOLUTION TIME T=TO+TAU 
S ( ^ : S ( 5 ) ; S ( 6 ) «XD» YO» ZD=VELDC I T Y COMPONENTS AJ SOLUTION TIME T.TO.TAU 
P( I,J) = PARTIAL DERIVATIVE DS(I)/DSO(J) OF SII) WITH RESPECT TO SOIJ) 

P 1 1 1 . J ) = PART I AL DS0I1>/DSCJ) WITH ROLES OF TO AND T REVERSED 
ACCI 1 )=-MU*SU)/(R**3)=ACCELERATION COMPONENT AT SOLUTION TIME T 
ACCOI I )=-MU*SO(I)/(RO**3)=ACCELERATION COMPONENT AT REF TIME TO 
R-RADIUS AT T IME T = SOUARE ROOT OF < X** 2+Y**2+Z** 2 > 

R 0 " R A D I U S AT TIME TO 

START OF INITIAL COMPUTATIONS 
DO 9 1=1,3 
SO ( I ) = XRO( 1 ) 

_ 9 SO( I + 3 ) = XVO ( I ) 

COMPUTE RADIUS RO * 

S1=DMAX1(DABS( SO( I) > ,DABS ( SO ( 2 ) ) ,DABS( SO ( 3 ) ) ) 

S 2 = ( S 0 ( l)/Sl)**2+( S0(2)/Sl)**2+<$0<3)/Sl)**2 
RO=2 * 


10 R=RO 

RO=C R+S2/R )# .5 
IF(RO.LT.R) GO TO 10 
R0=R0*S1 

c COMPUTE OTHER PARAMETERS 

SIGO=SO< 1)*SO(4)+SO(2)*SO<5)+SO<3)*SO<6) 

ALPHA=S0(4)**2+S0(5 )**2+S0<6)**2-2.*MU/R0 
C INITIALIZE SERIES MOD COUNT M TO ZERO 

C INITIALIZE BOUNDS PS1N AND PSIP FOR PSI OR SET PSI =0 IF TAU=0 
I F ( TAU ) 20,30,40 
20 PS 1N=-1 • 0+38 
PSIP=0. 

DTAUN= PS IN 
DTAUP=-TAU 

GO TO 50 
30 PS 1=0. 

GO TO 100 
40 PS I N=0. 

PS1P = +1* 0+38 

DTAUN=-TAU 

dtaup=psip 

c USE APPROXIMATION FOR PSI IF IT IS BETWEEN BOUNDS PSIN AND PSIP 
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50 

TRY 


GO TO 100 
SET EQUAL 


c< 

C 

C 

C 

C 

C 


END 


I F ( PS I *GT • PS IN • AND. P SI • LT .PS IP ) 

NEWTON* S METHOD FOR INITIAL PSI 
PS I = T AU/RO 

PST = TAU IF NEWTON 1 S METHOD FAILS 

IF l PSI .LE.PSIN.OR.PS I .GE.PSIP) PSI=TAU 

OF INITIAL COMPUTATIONS 


TO ZERO 


BY FACTORING OUT PSPS 


110 


SUM 

120 


BEGINNING OF LOOP FOR SOLVING KEPLER* S EQUATION 
BEGINNING OF SERIES SUMMATION nnTiui _ n 

COMPUTE ARGUMENT A IN REDUCED SERIES OBTAINED 
100 A=ALPRA*PS1*PSI 

n ‘IS ckos w,.» .» -w.tum 

AP = A 
M=M+ 1 
A= A*. 25 

IFIDABS(A). GT.l.) GO TO 110 

1 ‘ *A/90« )*A/56. )*A/30. ) /2^* rr , CA 

COMPUTE SERIES C3=S3/PSI**3 ,C2=S2 /PSI **2 ,C1*SI/PS1 tCO-SO 

C3=( .5+A*C5X3)/3. 

: C2=.5+A*C4 ( 

’! C1-1.+A*C3 

C0*1.+A*C2 

ieM OD F S E M MES°C0 G ANj°CK?F NECESSARY WITH DOUBLE ANGLE FORMULAS 

30 C1~C1*C0 

CO«2.*CO*CO-1. 

DE TERM I NE^C^ C3^CA ? C5X3^F ROM C0,CT,AP IF DEMOD REQUIRED 
C2= ( CO-1 • ) / AP 
C3=(C1-1. )/AP 
C4=(C2-.5)/AP 
C5X3=( 3.*C3-.5)/AP 
COMPUTE SERIES Sit $2-* S3 
140 S1-C1*PSI 

S2=C2*P$I*PSI 
S3-C3*PSI*PS1*PSI 
END OF SERIES SUMMATION 
, COMPUTE RESIDUAL DTAU AND 
G=R0*S1+SIG0*S2 
DTAU=(G+MU*S3)-TAU 
R=DABS(R0*C0+<SIG0*S1+MU*S2) > 

IF(DTAU) 200,300,210 
; RESET BOUND 
200 PS I N= PS I 

OTAUN=DTAU 
GO TO 220 

psip^psi 

NEWTON^S METHOD AND INITIALIZE SELECTOR N 
PSI=PSI-DTAU/R 
N~0 


FROM Cl ,C2 ,C3 


SLOPE R FOR KEPLER'S EQUATION 


210 

f TRY 
220 
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ACCEPT P'S I IF IT IS BETWEEN BOUNDS PSIN ANO PSIP 

230 I F C PS I . GT. PSIN. AND..PS1.LT. PSIP) GO TO 100 . . . oki c 

SELECT ALTERNATE METHOD OF COMPUTING PSI OR STOP ITERATIONS 
N=N+1 

GO TO ( 1 T 2* 3*4* 300 ) *N y * nTA „ /T Aii 

INCREMENTING BOUND WITH DTAU NEAREST ZERO BY /tau! 

IF ( DABS ( DTAUNI.LT. DA BS(DTAUP) > PSI-PSIN*( 1 .-(4.*DTAUN> /TAU) 


TRY 

I 


PSI =PS I P* 1 1 4.*DT AUP ) /TAU) 


C 

C 

c 


I F ( DABS ( OT AUP ) .LT .DABS < DT AUN ) ) 

GO TO 230 

TRY DOUBLING BOUND CLOSEST TO ZERO 

2 IFtTAU.GT.O. ) PSI-PSIN+PSIN 
IFtTAU.LT.O.) PSI=PSIP+PSIP 
GO TO 230 

TRY INTERPOLATION BETWEEN BOUNDS 

3 PSI=PSlN+( PSIP-PSIN)*(-DTAUN/(DTAUP-DTAUN) ) 

GO TO 230 

TRY HALVING BETWEEN BOUNDS 

4 PSI=PSIN+< PSIP-PSIN)*.5 
GO TO 230 

END OF LOOP FOR SOLVING KEPLER* S EQUATION 

COMPUTE REMAINING THREE OF FOUR FUNCTIONS FM1 *G *FD*GDM1 
300 FM1 =-MU* S2/R0 

fd=-mu*$i/ro/r . 

GDM1=-MU*S2/R 

COMPUTE COORDINATES AT SOLUTION TIME T=TO+TAU 
DO 310 1 = 1*3 

s( n=soi i)+(fmi*so( i )+g*so< 1 + 3 ) ) 

S( 1+3 ) = ( FD* $0 ( I )+GDMl*SO( I +3 ) ) + S0( 1 + 3 ) 

I XRF ( I ) =$ ( I ) 

10 XVF ( I ) = S ( 1 + 3) 

IF < IMTX.EQ. 0) GO TO 500 
COMPUTE ACCELERATIONS 
DO 320 1=1*3 
ACC < I >=-MU*S( D/R/R/R 
ACCOM ) = ~MU*S0( n/RO/RO/RO 

OF COMPUTATION FOR COORDINATES AND ACCELERATIONS 


320 

END 


C 
C 

C COMPUTATION OF PARTIAL DERIVATIVES 
C COMPUTE COEFFICIENTS FOR STATE PART I ALS 

U=S2*TAU+MU*(C4-C5X3)*PSI*PSI*PSI*PSI*PSI 

P< 1* 1)=-(FD*S1+FMI/R0)/R0 
P(lf2>'— FD*S2 
PI2,1)^FM1«S1/R0 
P(2,2>=FM1*S2 
P(l f 3)=P<l*2> 

P< lt4)=~GDMl*$2 
P < 2 * 3 ) =P ( 2 * 2 ) 

P(2*4)=G*S2 

P(3,1)=-FD*(C0/R0/R+1./R/R+1*/B0/R0) 

P( 3*2)=“{FD^SI+GDMI/R)/R 

P ( 4» 2 ) = — P M * 2 ) 

P(3*3)=P(3,2) 

P( 3* 4)=~GDM1*S1/R 
1 P(4*3)=-P< 1*2) 

P< 4* 4)=-P( 1*4) 
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c compute coefficients FOR mu partials 
P( 1 » 5 )«-Sl/RO/R 
P ( 2 1 5 ) -S2/R0 
| P(3 t 5)=U/RO~S3 

P 1 1 *6 1 «— P (1*5) 

P(2,6)=S2/R 

P13,6)=-U/R+S3 


DO 400 I* It 3 

C MATRIX ACCUMULATIONS FOR STATE PARTIALS 
DO 400 J- 1 1 4 ^ t 

PI ( Jt 1 )»P( J* 1)*S0(I )+P( Jt2)*S0(I+3) 

400 PI ( J f I + 3)=P< J*3)*S0< I )+PUt4>*S0<I+3) 

DO 410 

T 1*PI ( 1* J)+S(I+3)*PI ( 2* J )+U*S( I+3)*ACC0( J) 

P€i:iii%ll1l"pill.J + 3»+llI*3»*PII2.J + 31-O*SJi r 3>*S0<J + 3> 

P< 1 + 3* J)=S< I )*PI < 3* J) + SU+3)*PI <4, J)+U*ACC( I )*ACCO(J) 

420 P ( I +1; J +3^ = S I I I 4P I 1 3 1 J+3 ) + S ( 1 + 3 ) *PI ( 4* J + 3 ) -U*ACC { I ) *S0 ( J+3 ) 
P( I* ])=P(1 1 1 1+FMl + l# 

P( I, 1 + 3 > = P ( It I+3I+G 
P ( 1 + 3 * 1 > =P l 1+3*1 )+FD 
410 PC 1+3* I+3)*P( 1+3* 1+3) +GDM1+1. 

END OF COMPUTATION FOR PARTIAL DERIVATIVES 


C 

C 

C 


END OF PROGRAM - ALL OUTPUTS HAVE BEEN COMPUTED 
500 CONTINUE 
RETURN 
END 
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SUBROUTINE CSTE P ( TGO t RSV t REV* RMV *RSE ? RSM* R EM ,H , 
IDR4RSV,OR^RSE *DR^RSM T BIGJ ) 

DIMENSIC^ ,VEV(3) ,RMV« 131 ’ 

IVSE(3),RSM(3)»VSM( 3> tREM(3),VEM( 3) »DR4RSV(3) tDR^RS6(3U 
20RARSM(3),URSV(3) ,UREV(3) »URMV(3)tURSE(3),URSM(3) tUREM 3) 

3UMTX(3»3KSVSV(3t3},EVEV<3,3)»VMVM 3,3),SESE(3,3),SMS 3» 

4.EMEM ( 3 * 3 ) t BI G J ( 6.t 6 ) » TEMP 1 < 3 ) » TEMP2 ( 3 ) t TEMP3 < ,3 ) * TEMP4 3 r 

5TEMP5 { 3 ) * TEMP6I 3 ) * TEMP? I 3 ) * TEMP8 ( 3 ) t TEMP9 ( 3 ) R c M RSM(3> 

DIMENSION RSVRSV(3),REVREV(3) T RMVRMV(3)tR5ERSE(3 ,RSMRSM(3) 

IRE MR EMI 3)»DEVSE(3)tDSVS£ DMVSMI 3 ) *DSVSM 3 »DMVEM ( 3 * 
20EMSM( 3 ) »OEVEM (31 tOEMSE ( 3 ) * DSMSE ( 3 ) _ TO 

COMMON/ CONST /MS * ME *MM *GL 1 1 AUM*UT IME ♦ UVELM* ERRMAX »DTR 
RSV3=VMAG(RSV)**3 
R£V3=VMAG(REV)**3 
RMV3=VMAG< RMV)**3 


RSE3=VMAGIRSE>**3 
R$M3=VMAG( RSM ) **3 
RFM3 = VM AG t REM ) 

CALL UNI TV I RSV » UR SV ) 
CALL UN I TV ( REV»UREV) 
CALL UNITV(RMVfURMV) 
CALL UN IT V( RSE*URSE ) 
CALL UNITV<RSM,URSM) 
CALL UN ITV( REMtUREM) 


DO 1 1=1*3 

RSVRSV ( I ) ~RSV ( I ) /RSV3 
REVREV I I ) =REV I I ) /REV3 
RMVRMV ( I )=RMV( I ) /RMV3 
RSERSE(1)=RSE( D/RSE3 
RSMRSMI IJ=RSM( I } / R S M 3 
REMREM ( I ) =REM ( I ) /REM3 
DEVSE ( I } = RE VREV ( I)+RSERSE( I) 
DSVSEt I)=RSVRSV( D-RSERSEI 1 > 
DMVSM ( I )=RMVRMV( I )+R$MRSM< I ) 
OSVSM ( I )=RSVRSVI I )-R$MRSMt I ) 
DMVEM( I )= RMVRMV ( I J+REMREMI I ) 
DEMSMl I ) =REMREM( I)~RSMRSM< I ) 
DE VEM ( I ) = REVREV ( 1 ) -REMREMI I ) 
DEMSE l I )=REMREM( 1 )+RSERSE( I ) 
OSMSEI I ) = RSMRSM ( I J-RSERSE I I > 
DO I J=l»3 
UMTXf I » J ) = 0 • 0 
I F < I.EQ.J) UMT X ( I * J|=l *0 


CONTINUE 

CALL VVT(URSV,SVSV f 3) 

CALL VVT(UREV,EVEV,3) 

CALL VVT(URMV*VMVM,3) 

CALL VVTI URSE * SESE » 3 ) 

CALL VVT(URSM,$MSM*3> 

CALL VVT ( UREMf EMEM » 3 ) 

DO 2 1=1 *3 

SVSV< I ,J)=<UMTX( I » J)-3#0*SVSVt I ♦ J) ) /RSV3 
EVEV{ I, JJ-CUMTXC It J)-3-0*EVEVU t J-J J/REV3 
VMVM( I » J >~ ( UMTX { 1 1 J ) ~3.0*VMVM( I *J) J/RMV3 
SESE( I , J ) = ( UMTX ( I,J)-3.Q*SESE( It J) >/RSE3 




*• co 



=(UMTX( I , J)~3.0*SM$M(I ,J) )/RSM3 
s ( UMT X ( 1 1 J)“3.0*EMEM( 1 1 J) ) /REM3 


SMSM( 1 ,J ) 

EMEMf I, J) 

continue 

CALL MXV( SVSV,DEVSE, TEMP 1 , 3 , 3 ) 

CALL MXV(EVEV»DSVSE,TEMP 2 , 3 , 3 ) 

CALL MXV(SVSV,DMVSM,TEMP 3 , 3 , 3 ) 

CALL M XV ( VMVM , DSV SM , TEMP 4 , 3 , 3 ) 

CALL MXV( EVEV,OMVEM,TEMP 5 , 3 , 3 ) 

CALL MXV( SESE ,DEMSM,TEMP 6 , 3 , 3 ) 

CALL MXV( VMVM,OEVEM,TEMP 7 , 3,3 > 

CALL MXVl SMSM,DEMSE ,TEMP 8 , 3 , 3 ) 

CALL MXV{ EM 6 M,DSMSE,TEMP 9 , 3 , 3 ) 

00 3 1=1 ’l MS *ME*(TEMPl l I 1+TEMP2 ( I ) ) +MS*MM*< TEMP3 (I ) +TEMP4 ( I ) ) 
EMP5 ( I ) -TEMP6 ( I ) +TEMP7 ( I )+TEMP8( I)> riTruriD(M 

=-{M$+ME)*MM*TEMP6< 1 ) ~MM*MS*TEMP9 ( I ) +MM*ME*TEMP8 { \ ] 
={MS+MM)*ME*TEMP8( I ) +ME*MS*TEMP9 ( 1 ) -M6*MM*TEMP6 i I ) 


DR4RSVI I ) 
1+ME*MM*(T 
DR4RSE ( I ) 
DR4RSM ( I ) 


3 CONTINUE 

CPERR = VMAG( DR4RSV >/24«0 
H=D$QRT ( DSORT { ERRMAX/CPERR ) ) 
IF(TGO.LT.H) H=TGO 

DO 4 I = i , 6 

DO 4 J = 1 ,6 

01GJ( I , J ) =0-0 

IFLI.EG.J) BIGJ( I ,J)=1.0 

I F ( ( J— I ) • EO* 3 ) B I G J ( I t J ) -H 

4 CONTINUE 
RETURN 
END 
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SUBROUTINE C STEP3 ( TGO, REV f RMV , REM t H , DR4REV t B1 GJ I 
IMPLICIT REAL*8(A-H,M,0-Z) 

D I MENS ION RE V < 3 ) , RMVC3 ) , REM ( 3 > , DR4REV ( 3 ) t B I G J ( 6 , 6 ) ,UREV (3) , 
1URMVC 3 ) , RMVRMVC 3 } ,REMREM( 3 ) » REVREVC 3 J r OMVEM( 3),DEVEM(3)f 
2UMTXC 3,3 > ,EVEV( 3,3) ,MVMV( 3,3) ,TEMP1(3) ,TEMP2(3) 
C0MM0N/C0NST3/ME,MM,GAMMA,UDM*UT I ME , UVELM , ERRMAX , DTR 

REV3=VMAG( REV)**3 
RMV3=VMAG(RMV)**3 
REM3=VMAG(REM)**3 
CALL UNITVC REV,UREV) 

CALL UNI TV ( RMV , URMV ) 

DO 1 1=1,3 

RMVRMV ( I >=RMV( I ) /RMV 3 
REMREM( 1 ) = REM ( I )/REM3 
REVREVU ) = REV( I) /REV3 
DM V EMC I )= RMVRMV ( 3 ) +REMREMC I ) 

OEVEMC n=REVREVC I)-REHREMU) 

DO 1 J= 1 * 3 
UMT X ( I f J )=0. 

IFC I.EO.J) UMT X ( I, J>=1*0 

1 CONTINUE 

CALL VVT(UREV,EVEV,3) 

CALL VVT ( URMV ,MVMV , 3 ) 

00 2 1=1,3 - 

DO 2 J = 1 ,3 

EVE VC N J)=(UMTX( 1 , J ) -3. 0*EVEV ( I , J) I/REV3 

2 MVMVC 1 , J) = CUMTX( I , J ) -3 • 0*MVMV C I t J ) ) /RMV 3 
CALL MXVC EVEVfDMVEMfTEMPl ,3,3) 

CALL MXVCMVMV,DEVEM,TEMP2,3,3) 

DO 3 1=1,3 

3 0R4REVC I )=ME*MM*C TEMP1(I)+T£MP2(I)> 

CPERR=VMAG(DR4REV) /24.0 
H=DSQRT(DSORTCERRMAX/CPERR>|) 

IF(TGO.LT.H) H=TGO 

DO 4 1=1,6 
DO 4 J= 1, 6 
B I GJ C I » J > -0 • 

I F ( I # E 0 • J ) Bl G J (1,01 = 1*0 
IFC ( J — I ) *EQ*3 ) B1GJ(I,J)=H 
A CONTINUE 
RETURN 
END 
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SUBROUTINE DELRV I H, R5V, REV ,RMV, RSE »RSM, REM ,CRSV »CRE C t 
lCRSE,CRSM f .CREM f DR4RSV,DR4RSE,DR*RSM,RRSV,RVSV,RRSE * R V S E , • 

2RRSM t RVSM) 

DIMENSION SSV(3>,SEV(3),SMV13),SSE(3),SSM(3) , SEM ( 3 ) , DDRS V l 3 
1DDRSE(3),DDRSM(3) m cddmay nTQ 

COMMON/CONST /MS, ME, MM, GL1,AUM,UTIME,UVELM,ERRMAX,DTR 

H2=H*H 

H2 6=H2 /fc • 0 

H23=H2/3,0 

RSV3 = VMAG( RSV)**3 

REV3=VMAG< REV)**3 

RMV3=VMAG( RMV)**3 

RSE3=VMAG( RSE >**3 

RSM3= VMAG ( RSM ) **3 

REM3=VMAG< REM)**3 

CRSV3=VMAGICRSV)**3 

CREV3=VMAG(CREV)**3 

CRMV3=VMAG( CRMV)**3 

CRSE3=VMAG(CRSE )**3 

CRSM3=VMAG(CRSM)**3 

CREM3=VMAG(CR€M)'**3 

DO 1 1=1,3 

SS V ( I ) = CRSV ( I )/CRSV3-RSV( D/RSV3 
S E V ( I)=CREV( I)/CREV3~REV( I)/REV3 
SMV( I ) =CRMV ( I ) /CRMV3-RMV ( I ) /RMV3 
SSE( 1 ) =CRSE ( I ) /CRSE 3-RSE ( I ) /RSE3 
SSM< I )=CRSM( I ) /CRSM3-RSM < I J/RSM3 

%Vs\\ I^^Uv^KM^SSEU 1 KSv« I . SSM, n*SMV«t » » 

DORSE ( I)«(MS+ME)*SSEU >+MM*(SSM(I >-SEM(I ) ) 

DDRSM< I )»(MS + MM)*SSM< I )+ME*(S$E( 1 )+SEM( I ) > 

RRSVt I ) = H2# ( DRARSV ( I )*H23+DDRSV< 1)1/20*0 
RVSV( n»H*(ORARSV( I >*H 26 +DDRSV< I ) )/A.O 
RRSEl 1 )«H2* C DR4RSET I ) *H23+DDR SE ( 1 ) ) /20*0 
RVSE( I ) =H*(DR4R$E( I )*H26+DDRSE< I ) ) /4* 0 
■RRSMU >-H2*-( DRARSMl I )*H23+DDRSM( l ) ) / 20.0 

RVSM(n-H*(DR4RSMn)*H26+D0RSM(I ))M.O 

1 CONTINUE 
RETURN 
END 
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SUBROUTINE 0ELRV3 ( H , REV ,RMV , CREV , CRMV ,DR4REV t RREV , 

IMPLICIT RE AL*8 ( A-Hf M.t 0-Z ) nn<nc . M .. 

DIMENSION REV( 3) ,RMV<3 ) ,CREV< 3 ) »CRMV( 3 ) , DR4R EV ( 3 ) , 

1RVEVC 3 ) , SEV ( 3 ) , SMV ( 3 ) , DDREV ( 3 I iik<l . i M CDDM 

COMMON /CON ST 3 /ME , MM * GAMMA , UDM , UT I ME * UVE LM , ERRM 

H2 =H*H • 

UT i — U "3 t u r\ 


RVE.V ) 

(3) T RR EV ( 3 ) i 
ERRMAX ,OTR 


H2 3 = H2 / 3. 0 
REV3=VMAG(REV)**3 
CREV3-VMAG(CREV)**3 
RMV3=VMAG ( RMV ) **3 
CRMV3=VMAG(CRMV)**3 
DO 1 1=1,3 

SE V ( I ) =CRE V ( I ) /CREV3-REV ( I I/REV3 
SMV ( I ) =CRMV ( I >/CRMV3-RMV< I ) / RMV3 
DDRE V < I ) = ME*SEV< I )+MM*SMV( I ) 

RREV( I )=H2*( DRAREV( I>*H23+DDREV(1 ) )/20.0 
1 RVEVU ) =H* I DR4R6V ( I) *H26+DDREV ( I )) M.O 
RETURN 
END 



SUBROUTINE COMIC < REVMAG, VEVMAG, LON, THE, 01 NC ,OBL , R SEO , V SEO , 
IREVOt VEVO*RSVO*VSVOf VSV-I ) 

D I^MENS IONESCO SEO ('b^TrEVO l 3) »VEVO(3 )tRSVO(3) » VSVO ( 3 1 » 

^COMMON /CON ST /MStME^MMfGLltAUMTUTIME tUVELM 
COMMON/ FL AG/ 1MTX, I PV , 1RTRAJ, 1 PV ™’ 1 ^ ’ l T p n o t cn BL 

COMMON/TRIG/CLON,SLON,CTHE,STHE,CINC,SINC,COBL,SOBL 

I F ( I 7 ER *GT • 0 ) GO TO 1 
VC I R = D$QRT ( ME /REVMAG ) 

C I NC^DCOS ( 01 NC ) 

S1NC"DSIN(0 INC ) 

COBL=DCOS(OBL> 

SOBt=DSIN(OBL) 

1 CLON=DCOS ( LON) 

SLON=DSIN( LON) 

CTHE=DCOS ( THE ) 

RF VO ( 1 ) = REVMAG* ( CLON*CTHE~SLON*C INC* ST HE) 

! REVO( 3)=REVMAG*(-S0BL*( ; SLON*CTHE+CLON*Cl NC* STHE > 

1 +COBL* S INC* STHE ) 

\/FVOPC 1 ) =VEVMAG* ( -CLON*ST.HE— SL'ON*C INC*CTHE ) 

VE.VOP < 2 ) » VEVMAG* CCOBL* ( -SLON* STHE+CLON*C I NC*CTHE 

^ VEVOP( 3 )= VEVMAG* ( *-SQBL* (— SLON* STHE +CLQN*C INC *C THE ) 

! +CtiBL*SINC*CTHE> 

CALL UNITV( VEVOPttEMP) 

00 2 1=1 t3 

VEVO( I )=VCIR*T6MP( I ) 

VSVOU ) = VSEO( n+VEVOt 1 ) 

RSVO( 1 )=RSEO( 1 )+REVO( 1 ) 

2 VSVI ( I )=VSEO( I )+VEVOP( I ) 

RETURN 

END 
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SUBROUTINE CQMIC3 ( REVMAG, VEVMAG » LON, THE ,0 INC, RE VO f VEVO ,VEVOP ) 


IMPLICIT REAL*8( A-H,L-M,0-Z) 

DIMENSION REV0(3 ) ,VEVO(3> tVEVOP (3) ,TEMP( 3) 

COMMON/FLAG/IMTX, IPV, IPTRAJ, 1PVTM, IFILE,ITER, ITAR 

COMMON /CONST 3 /ME , MM, GAMMA ,UDM,UTIME , UV ELM , ERRMAX t OTR 
COMMON/ TR1G3/CLON, SLON, CTHE , STHE ♦ C I NC , S I NC 
I F ( ITER.GT.O) GO TO 1 
VC 1R=DSQR TIME/RE VM AG) 


C INC=DCOSt OINC ) 

S I NC=OS IN < 0 1 NO 
1 CLON=DCO $ ( LON ) 

SLON=DS INI LON ) 

CTHE=DCOS ( THE ) 

STHE = DS IN (THE ) - 

REVOt 1)=REVMAG*(CL0N*CTHE~SL0N*C1NC*STHE ) 

REV0( 2 ) =REVMAG* ( SLON*CTHE+CLON*C I NC*STHE ) 
REVO( 3)=REVMAG*SINC*STHE 

VEVOPI 1 )= VEVMAG* ( -C LON* ST HE— SLON*C I NC*CTHE ) 
VEVOP( 2 ) = VEVMAG* I -SLON* STHE+CLON*C INC*CTHE ) 
VEVOP( 3 )= VEVMAG* S I NC*C THE 


CALL UNITVIVEVOP, TEMP ) 

DO 2 1=1,3 

2 VEVOU )=VCIR*TEMP( 1 ) 
WRITE(6,100)REV0,VEV0 
WRITE! 6,101)VEV0P 

100 FORMAT < 1H0,T8, * REVO* ,T68, 'VEVO* /1H , 

101 FORMAT ( 1H , T 8 , * VEVOP * / 1H ,1P3D20.11) 
RETURN 

END 


1P6020.I1) 
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SUBROUTINE COMFG ( TST ART « T ENO ? RE VMAG t XO »0 INC tOBL » 

1 RS EO t VSEO t RSMOt VSMOt F D* TE$TRD*GD r TS I D, LTD* S 1 1 t SI 2 * S21 >S22t 
2UVI tUVP) 

IMPLICIT REAL*8( A-HtL-MtO-Z) 


DIMENSION DUVI (3) »0UM(3) tS12I ( 3*3) 

COMMON/CONST/MS,ME ,MMtGLlt AUM, UT I ME t UVE LM , ERRMAX * DTR 

COMMON/TRIG/CLONf SLONf CTHE, STHE »CINC» SINCt COBL t SOBL 

COMMON/ FLAG/ IMTXt I PVt IPTRAJt IPVTM, I F I LE 1 1 TER 1 1 TAR 
COMMON /T ARG/ AY » AZ ? AT AR ? RSVT AR t VSVTAR 
VE VMAG= XD ( 1 ) 

L ON= XD ( 2 > 

THE=XD( 3) 

VEVMPS=VEVMAG/UV6LM 

LOND=LON/DTR 

THED=THE/DTR 

WRlTE(6,i08> 

.WRITE- (6*1 01) XD » VEVMPS* LONDj THED u _ • 

CALL COM I C ( RE VMAG » VE VMAG t LON* THE »GI NC.t OBL *RSEO* VSEO,* 

1 C ALL f FOURBY aSTART^ TEN d! U vO,VSV I, RSEO,VSEO,RSMO, VSMOt 
1 PVO • RSVF « VSVF * RSEF * V SEF * RSMF * VSMF * SI 1 * SI 2 * $2 1 * S22 ) 

CALL RVEMV(RSVFtVSVFtRSEFtVSEFtRSMFtVSMF f REVF,VEVF,RMVFtVMVF, 

IREMFtVEMF) 

WRlTE(6,l02)RSVFtVSVF 
I F i ITER.GT.O) GO TO 11 

CALL IT CTArIrSEF?vSEF ,RSMF,VSMFtREMFtVEMF, AYt AZtATARtRSVTAR, 

1VSVTAR) 

L DO 2 I =1 t3 

TSI0( II=RSVF( II-RSVTARU > 

DV I ( I ) ~VSV I t I I-VSVOl I ) 

2 DVF( n«VSVTAR( l)-VSVF(n 
T6STRD=VMAG(TSID) 

DVIMAG=VMAG( DVI ) 

DVFMAG-VMAG ( DVF I 

dvimps^dvimag/uvelm 

dvfmps=dvfmag/uvelm 

CALL UN ITV ( DV 1 1 UV I ) 

CALL UNITV(DVFtUVF) 

fd=dvfmag 

CALL MXV(SlltUVItDUMt3t3) 

DO 21 I = 1 1 3 
1 DUM< I I =U VF ( I )-DUM< I ) 

CALL INVERT! S12*S12I > 

CALL MXV(S121fDUM»DUVlt3t3) 

WRITE!6*103)DVI.*UVI 

WRITE(6*104).DVF*UVF 

WRITE (6* 105)OUVI.t-TSIO Tr . rTn ^ 

WRlTE(6 t l06)DVlMAGtDVFMAGfDVIMPS,DVFMPSf FDtTESTRD 
ORODX ( 1 1 1 ) =o« ^ k 

DRODX( l t 2)=REVMAG*(-SLON*CTHE-CLON*CINC*STHE ) 
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DRODX ( 1 ,3 l-REVMAG* ( -CLGN*STHE-SLON*C I NC*CTHE > 

DRODX (2*2 )=REVMAG*COBL* ( CLON*CTHE-'SLON*CINC*STHE ) _ 
S5SoJcI;il-RlvMAG^CCOBt*C-SLON*.STME*CLON*CINC*CTHe> 

X +SOBL*SINC*CTHE ) 

DRODX ( 3»2 ) =-REVMAG*SQBL* ! CLON*CTHE**SLON*CI NC*S-THE ) 
DRODX ! 3*3)=REVMAG*!”SQBL 3 M -SLON*$THE+CLON*C INC*CTHE) 

1 +C.OBL* S IN'C*CTHE ) 

DVODX! l f 1>--CLON*$THE-$LON*CINC*CTHE 
DVODXt 1»2 )=VEVMAG*( SLON* STH6-CLON*C INC*CTHE > 

DVODX! It 3) =VEVMAG* ! -CLON*CTHE+SLON*C I NC* ST HE ) 

DVODX ( 2 t 1 ) =COBl* ! ~SLON*STHE+CLON*C I NC*CTHE ) 

1 +SOBL*SINC*CTHE 

DVODX ( 7 . 2 J=VEVMAG*COBl*!-CLON*STHE-SLON*CINC’ !t CTHE ) 

DvSox '{ I, 3 ) -vIvHAGHCOBL* ( -SLON*CTHE-CLON*e 1NC*STHE > 

1 -S0BL*S1NC*STHE ) 

DVODX ( 3* 1) =-SOBL* ( -SLON* STHE+CLON*C I NC*CTHE ) 

^DVODX ( 3*2) =~VE VMAG* SOBL* ( -CLON^STHE-SLON^C INC*CTHE ) 

DVODX!3,3)=VEVMAG*t-$OBL*<-SLON*CTHE-CLON*CINC*STHE> 


CALL 
CALL 
DO 3 
DO 3 


-COBLES INC* ST HE ) 

MXM( S21»ORODXtTEMPlt3t3t 3) 

MXM( S22t DVODXt TEMP2 t3t3 f 3) 

I = It 3 
^ J - 1 13 

TEMPI (’ J ?J ) -TEMPI ( I t J ) + TEMP 2 ! 1 ) 

CALL MTRANS(TEMPlt1EMP2,3,3) 

CALL MXV( TEMP2tUVEtGD»3f 3) 

DO 4 1=1*3 
Gom— GD.<n 
WRITE ( 6* 107 )GD 

CALL MXM ( S 1 1 * OROOX t TEMP 1 * 3 * 3 1 3 ) 

CALL MXM!S12*DV0DXtTEMP2t3t3t3) 

DO 5 1 = 1*3 
DO 5 J=1 t 3 

LTD! I * J ) sT.EMPl ( l f J) + TEMP2( I*J) 

CONTINUE 

FORMAT ( 1H0* T8t * XD ' * TfeB t 1 VEVMPS 

11P6D20.11 ) ^ # rsvf* *T 68, *VSVF*/1H tlP6D20.1i> 

,T8, 'DVI • tT68* 'UVI '/1H tlP6D20.11) 
f T8* * DVF ♦ *T68* r UVF '/1H tlP6D20.11) 

, T8 * ' DUV I * *T6B t 1 TS ID ' / 1H t lP6D20.ll) ■ 

t T8* * DVIMAG' *T28* * DVFMAG • t T48 * * DV I MPS • t T68 , • DVFMP S t 

1TB8VFD* fTlOfiif 'TESTRD'/IH , 1P6D20.11) 
i 07 FORMA T ! 1H f T 8 1 • GO * ✓ 1 H , 1P3D20.11) ^ 

.08 FORMAT ! lHOtTBt * 

RETURN 

END 


5 

101 

102 

103 

104 

105 

106 


t T88 1 1 LOND ' *T 108 1 • THED • / 1H * 


FORMAT! 1H 
FORMAT ( 1H 
FORMAT! 1H 
FORMAT ( 1H 
FORMAT ( 1H 


184 



SUBROUTINE COMPG3! T START, TEND, REVMAG, XD,OINC , REMO, 

1VEMO, FOtTESTRO, GD,TSID, LTD, SI 1 , S12, S21 ♦ S22,UV1 ,UVF) 

CM MENS 1 0N^R£M0^3* * VEMoT^) t REVOI 3 ) ’ p^p? * ? (* 3 ) ^S1 1 i 3^3^ ' XO ( 3 ) * 

lVEVTAR(3),PV0(6),REVFt3),VEVF(3),REMF(3),VEMF 3),SU 3,3),XO(3), 

2 S 12 ( 3 , 3 ),Sn( 3 , 3 KS 22 ( 3 , 3 ),TSID( 3 ),OVI 2),UVI(3),DVFC3),UVF(3), 

30R0DX ( 3, 3 ) ,OVODX( 3 » 3 ) , TEMPI (3, 3), TEMP 2(3, 3), GO !3j ,LTD.13*A) 
DIMENSION DUVI(3)tDUM(3)tS12I{3f3) coDUAv htq 

COMMON /CON ST 3 /ME ,MM , GAMMA ,UDM,UT I ME ,UVELM , ERRMAX » DTR 

COMMON/ TR1G3/CL0N,SL0N,CTHE,STHE,C1NC,S INC 
COMMON/FLAG/ IMTX, I PV,IPTRAJ,IPVTM, I FILE, I TER, I TAR 

COMMON/ TARG/ AY, AZ, AT AR-, REVTAR, VEVTAR 
VEVMAG=XD( 1) 

LON=XO( 2) 

THE=XD ( 3 ) 

VE VMPS= VE VMAG/UVE LM 

lond=lon/dtr 

thed=the/dtr 

WRITE!6,108) _ 

ud i t F f A* 1.0 1 1 XD • VE VMP S , LOND , THED 

CALL COMIC3! REVMAG, VEVM AG t LON, THE *OINC»REVO,VEVQ ,V6V0P ) 

CALL THRBDY (TST ART, TEND, REVO, VE.VOP, REMO, VEMO, PVO,REVF t VEVF , 
IREMF, VEMF , Sll ,S12,S21?S22) 

WRITE! 6,1 02) REVF, VEVF 
I F < ITER.GT.O) GO TO 11 
I F ( I TAR^GT* 0 ) GO TO 11 

CALL CTAR3 (REMF, VEMF, AY, AZ, AT AR, REVTAR, VEVTAR) 

n DO 2 1 = 1,3 

TSIOm = REVF( I )~REVTAR< 1 ) 

OVI ( I ) = VEVOP! I ) -VEVO! 1 ) 

2 OVF( I)=VEVTAR( I)-VEVF( I) 

TESTRD=VMAG!TSID) 

DV1 MAG=VMAG( DV I ) 

DVFMAG-VMAG! DVF ) 

DV1MPS=0VIMAG/UVELM 
OVFMPS=DVFMAG/UVELM 
CALL UNITV(OVI,UVI) 

CALL UNITV(DVF,UVF) 

FD=DVFMAG 

CALL MXV! Sll, UV 1 , DUM, 3,3) 

DO 21 1=1,3 

21 DUMCn-UVF(n-DUMU) 

CALL INVERT (S12,S12I) 

CALL MXV! SI 2 1 , DUM,DUV I ,3,3 ) 

WRITE ! 6, 103 )DV1 ,UVI ■■■ 

WRITE (6,1 04 )DVF ,UVF 

WRITE ! 6, 105)0UVt ,TSID 

WRITE! 6, 106)DVIMAG,DVFMAG, DV1MPS,DVFMPS,FD,TESTRD 
DRODX! l f ,2)«REVMAG*(-SL0N*CTHE-CL0N*CINC«STHE) 

DRODX ! 1 , 3 ) =REVMAG* ! -CL0N*$THE-SL0N*C I NC*CTHE ) 
DROOx!Il 2 )*REVMAG*(CLON*CTHE-SLON*CINC*STH€ ) 

DRODX(2,3)=REVMAG*!-SLON4STHE + CLON.CINC*CTHE) 

OROOX! 3, 1)=0. 

0R0DX!3,2)=0. 

DRODX! 3,3i=REVMAG*SlNC*CTHE 
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5 

100 

101 


QVODxn fl )=-CL0N*STHE-S'L0N*C1NG*CTHE 
DVOOX! 1 1 2 ) =VEVMAG*( 5L0N*STHE-C-L0N*C1 NC#CTHE ) 

DVODX ( 1 * 3 ) =VEVMAG* ( *~CLON*CTHE + $LpN*C I NO* S THE ) 

DVODX (2,1) = -SLO N* ST HE+CLON*C I NC*CTHE f ■ 

DVODX l 2 * 2 )*VEVMAG* ( -CLGN*STHE-SLON*C INC*CTHE ) 

DVODX! 2*3) a VEVMAG*t-SLON*CTHE-CLON*CINC*STHE) 

DVOOX ( 3, n» SI NC*CT HE 
DVODX l 3 * 2 ) =0 • 

DVOOX ( 3*3 )*-VEVMAG*SINC*$THE 
CALL MXM{ S2 1 *DRODX* TEMPI * 3* 3 *3 ) 

CALL MXM ( S22 * DVODX * TEMP2 *3*3*3) 

DO 3 1=1,3 

00 3 J= 1 * 3 , „ 

TEMPI! I*J)*TEMPl( It J 1 + TEMP2 < I * J ) 

CALL MT R ANSI TEMPI * TEMP2* 3*3 ) 

CALL MXV ( TEMP2 *UVF *GD* 3 * 3 ) 

DO A- 1=1*3 
GD! I ) =~GD( I) 

WR I TE ( 6* 107 )GD 

CALL MXM t $ 1 1 *DROOX * TEMPI * 3 * 3 » 3 ) 

CALL MXM( S 12* DVODX* TEMP2* 3*3*3) 

DO 5 1=1*3 
DO 5 J= 1 * 3 

LTD! I * J) =TEMP1 ( I * J) +TEMP2! I * J ) 

FORMA T^l HO *T 8 * 1 COMPUTED TARGET 1 /1H0* T8 * * REVT AR • *T68 * • VEVTAR * / 

1 FORMAT tl HO ^T8* • XD » , T68 , • VEVMPS 1 *T88* 'LOND' , T 108 * • THEO * / 1H * 


1 

102 

103 

106 

105 

106 

] 

107 

108 


1P6D20.11 ) 
FORMAT! 1H 
FORMAT! 1H 
FORMAT ( 1H 
FORMAT! 1H 
FORMAT! 1H 


*REVF 1 *T68* 1 VEVF • /1H *1P6D20.11) 
*DVI ' *T68* 'UVI */lH * 1P6D20. 1 1 ) 
«DVF« *T68**UVF»/1H *1P6D20.11> 

» DUV 1 1 * T68 * 1 T S 1 D • / 1H f lP6D20.il ) 
»DV I MAG* *T28* • DVFMAG* *T68* 

T88 * 1 FD* *T108* * TESTRO * /1H * 1P6020.U) 

FORMAT ( 1H *T8* , GD , /'1H *1P3D20.11) 

FORMAT! 1H0*TB* ' ~ } 

RETURN 
END 


* T8 * 

* T8 * 

* T 8 * 

* T8 * 
» T 8 * 


• DV1MPS ' *T68 * * OVFMP S * * 




u u 


SUBROUTINE COME ( TSTART , TM, TEND, RSVO.VSVO, VSVI ,RSEO,VSEO,RSMO, 

1VSM0,ERRMIN,ILINC,KNRSAV,ITERD,ITLMAX,RSVM0,VSVMPD,RSVTAR, 

2 VSVTAR, S11D, S120,RSVM,VSVMM,VSVMPtDV»UVl , UVM, UVF, SMI 1 It SMI 12, 
35MI21 »SMI22,SFM11 ,SFM12,SFM21 i SFM22) 

EXTRAPOI^ SOLVE LAMBERT PROBLEM FROM TM TO 

D I MENS ION RSVO ( 3 ) ,VSVO ( 3 ) , VSV I( 3 ) , RSEOl 3 > ♦ V$EO{ 3) , RSMO {3 ) » 

1VSM013) fPV0<6)*RSVH(3)fVSVHM(3>,RSEM<3)*VSeHCB)jRSMH<3)*^ 

2VSMM (3), SM II 1(3,3), $M 112(3,3) , SMI 21 ( 3 , 3 > , SM 1 22 ( 3 , 3 > , SFM1 1 ( 3 , 3 ) f 
3SFM12(3, 3),$FM2 1(3,3), SFM22(3»3),S 110(3,3) , S12D( 3 ,3 ) , 

4RSVMX ( 3 ) ,VSVMPX(3),DRM(3),TEMP1(3,3) ,DUM(3) » M 

5RSVF<3), VSVFI 3) tRSEF(3) tVSEFl 3), RSMFC 3), VSMF(3),VSVMP (3)* 

60V 1 ( 3) ,DVM(3) tDVF(3) tOVl(3) tUVM(3 ) tOVF(3)f DVMPX13) 

DIMENSION RSVTAR(3)»VSVTAR(3) tRSVMO(3)tV5VMPD(3) 

COMMON/CONST /MS ,ME ,MM, GL1*AUM»UTI ME ,UVELM, ERRMAX ,DTR 
KNR = KNR SA V 
WR I TE ( 6, 100 ) 

WRITE ( 6, 101 )VSVI,TM 

ADVANCE STATES FROM TSTART TO TM 

CALL FOUR BY (TSTART , TM , RSVO ’ VSV I » R SEO» VSEO » R SMO * VSMO * 
iPVOtRSVM t VSVMMfRSEMt VSEMf RSMMtVSMM , SMI 1 1 , SMI 12 , SMI 21 , SMI 22 ) 

I F ( I TERD* GT«0 ) GO TO 3 
DO 2 1=1,3 
VSVMPXM >=VSVMP( I) 

2 RSVMXC I ) =RSVM( I) 

CAt^LAMBUMtTEND.RSVMX.VSVMPX.RSEM^ 

1ERRM1N, RSVTAR*RSVF tVSVF»RSEFt VSEF, RSMF f VSMF* SFMUt SFM12» SFM21 »• 

2SFM22) 

INCREMENTAL SOLUTION OF SECOND LEG LAMBERT PROBLEM 

3 DO A 1=1,3 
VSVMPXU 1= VSVMPD( I) 

RSVMX ( I )=RSVMD( I) 

DRM ( I)«(R.SVM( I ) -RSVMO( I) I/ILINC 

DO 4 J*l,3 

SFM1K I , J ) = S 1 ID ( It J) 

4 SFM12( ItJ)*S12f)U t J) 

WRITE ( 6, 102 ) RSVMD,RSVM,DRM, IL INC 
WRITE(6,106)VSVMP0 

DO 7 I TERL-l , IL INC 

INVERT! SFM12, TEMPI ) 

MXV ( SFM 1 1 ,DRM, DUM ,3,3) 

MXV(TEMP1, DUM ,DVMPX , 3,3) 

1=1,3 
DVMPXI I )=— DVMPX ( I ) 

RSVMXC I ) =RS VMX ( 1 ) +DRM ( I ) 

5 VSVMPXt 1 )=VSVMPX( I)+OVMPX( I) 

WRITE (6, 103 )1TERL, DVMPX, RSVMX, VSVMPX 

6 r &LL K LAMB(TM,TEND,RSVMXtVSVMPX,RSEM,VSEM,RSMM,VSMM, 

1KNR, ITLMAXf ERRMiN, RSVTARf RSVFfVSVFVRSEF,VSEFfRSMF f VSMF,SFMllt 
2SFM12,SFM21,SFM22) 

7 CONTINUE 

SAVE VSVMP AND COMPUTE DV 
71 DO 6 1=1,3 


CALL 
CALL 
CALL 
DO 5 
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VSVMP ( I ) =V$VMPX( I ) 

OV! ( 1 ) = VSVI ( I >-VSVO( I ) 
OVM ( I ) =V SVMP ( I )-VSVMM( I ) 
8 OVF< I )=V$VTAR( I )-VSVF<l ) 
DVIMAG=VMAG(DVI ) 


DVMMAG = VMAG< DVM ) 

D V F M A G = V M A G U)V F ) 

OV»DV IMAG+DVMMAG+DVFMAG 
OVIMPS=DVIMAG/UVELM 
DVMMPS^ DVMMAG/UVELM 

dvfmps=dvfmag/uvelm 

OVMPS=OV/UVELM 
CALL UNITVXDVI ,UV I > 

CALL UNITV(DVM,UVM> 

WR^I TE ( 6 1 1 04 ) DV I ,UV I f DVM»UVM, DVF ,UVF, DVIMAG,DVMMAG*DVFMAG, 
1 DV,DVIMPS»DVMMPStOVFMPS tDVMPS 

100 FORMAT ( 1H0* 40X» ‘FIRST LEG TR A JECTORY* ) 

int cpD M a T ( 1 HO . T 8 . • V SV I • *T 68 1 1 TM 1 / 1H tlP4D20.11) • 

102 FORMAT! 1H0.T8,' SOLVE SECOND LEG LAMBERT PROBLEM JN INCREMENTS 
l/lH0»T8*’RSVMD , tT68t'RSVM’/lH , 1P6D20. 11/ 1H »T8, DRM ,T68, 

103 2 F0RMAT(lHl,T8^HTERLST28t 'OVMPX' /1H , 1 10 r 10* , 1P3D20. 1 1 / 1H ,T8 

lOA^S^^^r^^^^.J^^H^lpODaO.ll/TH f T8 » 'OVM • f T 68 » 
l'UVM'/lH , 1P6D20.11/1H , T8 , • DVF ' , T68 , • UVF ' / 1H ,1P6D ^*i l ^ 1 ’ 

2T8, •DVIMAG* * T28 1 ' DVMMAG • , T48 , • DVFMAG !• , T68 , > DV • /1H *IP ^°* 1 1 

31H t T8, ‘DVIMPS 1 *T28 t ‘DVMMPS 1 »T48* 'DVFMPS' »T68* OVMPS /1H t 

A1P4D20.11) 

106 FORMAT ( 1H v T 8* 1 VSVMPD • / 1 H , lP3D20.il) 

RETURN 

END 
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SUBROUTINE COMF3 ( T ST ART , TM , TEND , RE VO, VEVO , VE VOP , REMO , VEMO , 

lERRMIN, ILINC,KNRSAV,lTERD,ITLMAX,REVMD,veVMPD,REVTAR,VEVTAR, 

2S1 lD f S12D,REVM, VEVMM, VEVMP,DV, UVl , UVM,UVF , SMI 1 It SMI 12, SMI 21 , 
3SMl22tSFMll,SFM12tSFM21fSFM22) 

TM°ANO SOLVE LAMBERT PROBLEM FROM TM TO 

DIMENSION REV013) ,VEVO(3) ,V£V0P(3) ,REM0(3) ,VEM0( 3) ,PVO(6) , 
1REVM( 3 ) ,VEVMM( 3),VEVMP(3)»REMM(3) » VEMM< 3), SM 111(3,3), SM 112(3,3 

2SM12 1( 3,3 ) ,SMI 22(3,3 ) ,SFM11( 3,3) ,SFM12< 3,3) ,SFM21 (3,3) , 
3SFM22(3»3),S11D(3,3),S12D( 3,3) ,REVMX(3),VEVMPX (3) ,DRM(3) , 

4REVF(3),VEVF(3),R€MF(3),VEMF(3),DVI(3),DVM(3>*DVF(3) , 

SUVI(3) ,UVM(3) ,UVF(3) , DVMPX ( 3 ) , RE VT AR < 3 ) ,VEVTAR(3) ,REVMO(3) r 
6VEVMPD(3), TEMP 1(3,3), DUM ( 3 ) 

COMMON/ CON ST3 /ME ,MM,GAMMA* UDM,UT 1 ME , UVELM » 6RRMAX , DTR 
WRITE ( fe, 100) 

WRITE! 6,101 )VEVOP,TM 

ADVANCE STATES FROM TSTART TO TM 

CALL THRBDY ( TST ART, TM, REVO, VEVOP, REMO, VEMO, PVQtREVM, VEVMM, 

1R6MM, VEMM, SM111,SMI 12, SMI21 , SMI 22 ) 

I F ( I TERD. GT. 0 ) GO TO 3 

DO 2 1=1,3 

VEVMPX( 1 )=VEVMP( I) 

2 REVMXt I )=REVM( I ) 

C ALL AMB3< TM, TEND, RE VMX, VE VMPX »R EMM, VEMM, KNR , I TLMAX ,6RRMI N, 

1 RE VTAR* RE VF, VEVF, REMF » VEMF, SFM1 1 , SFM12, SFM2 1 * SFM22 ) 

Incremental solution of second leg lambert problem 

3 DO 4 1=1,3 

VE VMPX ( 1)=VEVMPD( I ) 

REVMXi I)=REVMD( I) 

DRM ( I ) = ( RE VM ( D-REVMDU ) )/ILlNC 
DO 4 J = 1 ,3 

SFM1K I , J ) = S 1 10 ( I,J) 

4 SFM12 ( I, J)sS12D( I,J) 

WRITE ( 6t 102 )REVMO,REVM,ORM, IL INC 

WRITE(6,106)VEVMP0 

DO 7 ITERL=1, ILINC 

INVERT(SFM12, TEMPI) 

MXV( SFM11, DRM , DUM, 3,3) 

MXV ( T EMP 1 , DUM, DVMPX , 3,3) 

1 = 1,3 

DVMPX ( I ) =— 0 VMP X ( I ) 

REVMXt I } = RE VMX ( I )+DRM( I ) 

VEVMPX( I )=VEVMPX( D+OVMPX ( I ) 

WR1TE( 6, 103 ) I TE RL, DVMPX, REVMX,VE VMPX 

CALL L AMB3 ( TM, T END, RE VMX, VE VMPX, R EMM, VEMM, KNR, I TLMAX , ERRM I N , 
1REVTAR ,REVF , VE VF , REMF, VEMF , SFM1 1 , SFM12 , SFM2 1 , SFM22 ) 


CALL 
CALL 
CALL 
DO 5 


71 


8 


CONTINUE 

SAVE VEVMP AND COMPUTE DV 

DO 8 1=1,3 

ve vmp ( i)=vevmpx( n 

DVI ( I )=VEVOP( I)“VEVO( I ) 
DVM( I ) =V EVMP ( I ) -VEVMM (I ) 
OVF ( I ) = VE VT AR ( I ) -VEVF ( I) 
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DVlMAG=VMAG<DVn 

OVMMAG=VMAG(OVM) 

DVFMAG=VMAG(OVF) 

DV=DV IMAG+DVMMAG+DVFMAG 
DV I MPS =DV I MAG/UVE LM 
OVMMPS^OVMMAG/UVELM 
DVFMPS=DVFMAG/UVELM 
DVMPS=DVMAG/UVELM 
CALL UN1TVC DVI *UV 1 ) 

CALL UN 1 T V I DVMf UVM ) 

CALL UNITV<DVF,UVF> . 

WRITE{6tl04)DVItUVI t DVM f UVMt DVF , UVF * DVIMAGt DVMMAGt DVFMAGr 
1DV, DVIMPS* DVMMPStDVFMPSt DVMPS 

100 FORMAT ( lHOt^OX, * FIRST LEG TRAJECTORY*) 

101 F0RMAT(lH0tT8,*VEV0P'tT68,*TM*/lH t 1 tK1 TKir ocmpmtc* 

102 FORMAT( 1H0»T8» * SOLVE SECOND LEG LAMBERT PROBLEM IN *^ C 5fo ENTS 
1/1H0,T8 t »REVMD* *T68t *REVM*/ 1H , 1P6D20 . 1 1 / 1H »T8 » 1 DRM* tT68 t 

2‘IUNC/IH ♦1P3D20.11»I10) iW11J TQ 

103 F0RMATUH1,T8,» ITERL*tT2Bf *DVMPX*/1H f 1 1.0* 10X , 1P3D20 . 1 1/1H ,T8, 

1‘REVMX* tT68» ' VE VMPX * / 1H « 1P6D20.11) T ' 

104 FORMAT ( 1 HO » T8 » • OV I • *T68* *UVI */lH tlP6D20.il/lH *78 t DVM ,T68 f 
1»UVM»/1H , 1P6D20.11/1H * T8 , • DVF • , T68 , • UVF • / 1H >1P6D20.U/1H f 
2T8 f 'DVI MAG' »T2 8 f * DVMMAG » , T48 t ' DVFMAG • »T6B, *DV« /1H t 1P4D20.11/ 

3 1H ,T8» »DV IMPS' »T28» ' DVMMPS* »T48 f 'DVF MPS* »T68 t »DVMPS* /1H t- 
41P4D20.il) 

106 FORMAT ( 1H , T 8 , • VEVMPD ' / 1H tlP3020.ll) 

RETURN 

ENO 



190 



SUBROUTINE COMGf SM 1 11 , SM 11 2 , SMI 2 1 , SMI 22, SEMI 1 , SEMI 2 , VTMP , 

1 VTMM f UV I ,UVM,UVF,DUVI , DUVMM »OUVMP , G ) 

IMPLICIT REAL*8<A-H,0-Z) 

DIMENSION SMI 11(3, 3) , SMI 12 <3 ,3 ) » SM 1 2 H3»3 ) *SMI22< 3 , 3) , 

1SFM1 1 ( 3, 3 ) , SFM12! 3 ,3) » VTMP( 3 ) , VTMMl 3) ,UV1 ! 3) ,UVM( 3) ,UVF (3 ) ♦ 

2G(4) »SMI 12I(3»3) ,TEMP1( 3,3) ,DUM1(3) ,DUM2(3) ,DUM3(3) , _ ovM(3) 

3SFM12I ( 3,3) ,DUVI< 3 ), DUVMM! 3 ) ,DUVMP( 3 ) , SMI1 2T ( 3 , 3 ) ,GV I (3) ,DVM{ 3 
CALL INVERT! SM 11 2 , SM 1121) 

CALL MXV! SMI 11,UVI ,DUM3,3,3) 
nn i i = i.3' 


1 DUM3( IJsUVMU )-DUM3C I) 

CALL M XV ( SM 1121, DUM 3 , DUV I ,3,3) 
CALL MX V ( SMI 22 * DUV I , DUM2 *3,3) 
CALL MXV( SMI21,UV I , DUM 1,3, 3) 


DO 2 1-1,3 

2 OUVMMt I ) »DUM1 ( 1 ) +DUM2 ( 1 ) 

CALL INVERT! SFM12,SFM12I) 

CALL MXV ! SFM 1 1 , UVM, DUM1 ,3,3) ' 
DO 3 1=1,3 

3 DUM1U )=UVF( I )-DUMl! I ) 

CALL MX V ( SFM1 2 1 , DUM 1 , DUVMP ,3,3) 
PVMMAG=DOT ( DUVMM , UVM , 3 > 
PVPMAG=OOT ( DUVMP, UVM, 3 ) 

CALL MTR ANS t SM II 2 , SM 1 12T , 3 , 3 ) 

DO 4 1=1,3 

4 DUM3( 1 )= DUVMP! 1 ) -DUVMM ( I ) 

CALL MX V( SMI 12T ,DUM3, GV 1,3,3) 

DO 5 1=1,3 

G( I ) =GV 1 ( I ) 

3 DVMU)-V.THP( n-VTMMd-) 

G( 4)=~DQT(0UVMP,DVM,3 ) 

WR I TE ( 6, 100 ) DUV I , PVMMAG , PVPMAG 
WRI TE ( 6, 10i ) DUVMM, DUVMP 


WRITE! 6, 102 )G 

100 FORMAT ( 1H ,T8,»DUVI't 

101 FORMAT! 1H ,T8, 'DUVMM* 

102 FORMAT! 1H ,T8,«G»/IH 
RETURN 

END 


T68, * PVMMAG *,Tfi8, » PVPMAG* /1H 
, T68, *DUVMP*/1H , 1P6D20.11) 

, 1P4D20.11) 


1P5D20.11) 



SUBROUTINE CT AR I RSEF , VSEF , RSMF , VSMF , REMF , VEMF , AY , AZ , ATAR ,RSV TAR , 
1VSVTAR) 

IMPLICIT RE AL*8 ( A-H, K— M , 0-Z ) 

DIMENSION RSEF(3),VSEF< 3 ) , REMF < 3 ) , VEMF ( 3 > , RSVTAR 1 3 ) ,V$VTAR(3) , 
1RSL1I3) ,VSL1 ( 3) ,-UXLS(3) ,TEMP< 3) ,UZL$< 3 ) ,UYLS( 3 I ,CLS <3, 3 ) , 

2C St ( 3 , 3 ) » RLTARL( 3 ) ♦ VLTARL ( 3 ) , RLTAR I 3 ) ,TEMP1(3) ,OMG$L<3) 

DIMENSION RSMF < 3 1 * VSMF ( 3) 

COMMON/FLAG/ IMTX, IPV ,1PTRAJ, IPVTM, I F 1 LE , I TER , 1 TAR 
COMMON/CONST/MS*ME ,MM,GL1,AUM,UTIME,UVELM,ERRMAX,DTR 
MEM=MM/( ME+MM) 

WR I TE ( 6, 100 ) 

DO I 1=1,3 

RSL1I I> = U.-GL1)*(RSEF( I )+MEM*REMF(I )) 

1 VSLim=U.-GLl)*tVSEFm*MEM*VEMFU > > 

IFUY.NE.O.) GO TO 11 

1 F ( A Z «NE *0 # ) GO TO 11 
DO 12 1=1,3 
RSVTAR(l)*RSLl( I) 

12 VSVTARf I)=VSL1( 1) • ' 

GO TO 5 

11 CALL UNITV (RSLltUXLS) 

CALL V XV < RSEF , VSE F , TEMP ) 

CALL VXV(RSMF, VSMF, TEMPI) 

DO 13 1=1,3 

13 TEMPI n=ME*TEMP(I)+MM*TEMPlU > 

CALL UNI TV (TEMP,UZLS) 

CALL VXV( UZLS, UXLS ,UYLS ) 

00 2 J = 1 , 3 

CL S ( 1 » J ) =UXLS ( J ) 

CLS(2,J)=UYLS( J) 

2 CL S ( 3 , J ) = UZLS ( J I 

CALL MTRANS(CLS,CSL,3,3) 

MU=(ME+MM)/(MS+ME+MM) 

BL = ( 1 * -MU ) / ( 1 • -GL 1 ) **3+MU/GL 1**3 

OMEGAN=DSORT< 1 . -BL/2 .+DSORT U 3 •* BL/2* )**2-2,*BL)) 
KTAR=2.*OMEGAN/(OMEGAN**2+2.*Bt+l. > 

CATAR=DCOS( ATAR) 

SATAR=DS I N ( ATAR) 

RLTARL ( 1 ) =KTAR*AY*SATAR 
RLTARL(2)=AY*CATAR 
RLTARL(3>=AZ*SATAR 
' VLTARL! 1)=KTAR*0MEGAN*AY*CATAR 
VLTARU 2>=-0MEGAN*AY*$ATAR 
VLTARU3 )=OMEGAN*AZ*CATAR 
WRITE! 6t 101 IRLTARL , VLTARL 
CALL MXV(CSL,RLTARL,RLTAR,3,3) 

RMAG=VMAG< RSL1 ) 

VY=D0T(UYLS,VSL1,3) 

DO 3 1=1,3 

3 OMGSL< U*VY*UZL*S( U/RMAG • 

CALL VXV( OMGSL , RLT AR, TEMP ) 

CALL MXV(CSL,VLTARL,TEMP1,3,3) 

DO A 1=1,3 

RSVTARII )=RSLK 1 ) +RLTAR ( 1) 

4 VSVtARI I)=VSLl( I J+TEMP1 ( I )+TEMP( I ) 

5 CONTINUE 

WRITE! 6,1 02 ) RSVTAR , V $VT AR 
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WR1TE(6*'103) 

100 FORMAK 1H0,T8, 'COMPUTED TARGET*) 

101 FORMAT ( 1 HO » T8 f * RLTARL ' t T68 , • VLTARL • / 1H 

102 FORMAT (1H » T 6 r 1 RSVT AR ' » T68 , ♦ V SVT AR ' / 1H 

103 FORMAT ( 1H0 ) 

RETURN 

END 


, 1P6D20 • 1 1 > 
1 1 P6D20 • 1 1 ) 
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SUBROUTINE CTAR3! REMF * VEMF , AY T A Z 1 AT AR ,REVt AR * VEVTAR ) 

IMPLICIT REAL*8 ( A-H, K-MtO-Z > 

DIMENSION REMF ! 3 I , VEMF! 3) , RE VT AR ( 3 ) , VEVT AR ( 3 ) ,REL(3) *VEL 31 * 

1UXLE! 3) *TEMP(3) ,UZLE( 3)*UYLE(3 ) *ClE(3*3 )*CEL<3,3) *RLTARL(3> * 

2VLTARL (3 ) ♦RLTARC3 ) t TEMPI ( 3 ) ♦OMGEL ( 3) 

COMMON/ FLAG/ IMTX, I PV, JPTRAJ, J PVT M, I F I LE , I TER , I T AR_ 

COMMON /CON ST 3 /ME ♦ MM ♦ GAMMA ♦ UDM * UT I ME ♦ UV ELM , ERRM AX *DTR 
WR I TE ! 6 * 100 ) 

00 1 1=1,3 

REL ( I )=( 1. -GAMMA)* REMF ( t ) 

1 VEL { I ) = ! 1 •-GAMMA )*VEMF ( I ) 

1 Ft AY.NE.O. I GO TO 11 
IFI AZ.NE.O. ) GO TO 11 
00 12 1=1,3 
REVTARU )*REL(I) 

12 VEVTAR! I)=VEL( I) 

GO TO 5 ! 

11 CALL UN I T V ( R E GM * UX L 6 ) 

CALL VXV! REMF , VEMF » TEMP ) 

CALL UNITV(TEMPtUZLE) 

CALL VXV!UZLE,UXLE*LYLE) 

00 2 J- 1*3 

CLE 1 1 ♦ J ) =UXLE ( J ) 

CLE ( 2 , J ) =UYLE ( J ) 

2 CLE l 3 , J ) *UZLE ( J ) 

CALL M TRANS! CLE *CEL*3*3) 

MU=MM/ ( ME+MM ) 

BL= ! 1.-MU1 / ( 1« -GAMMA ) **3+MU/GAMMA**3 

OMEGAN = DSORT ! 1 •-BL/2 •+DSORT ( ( 3 .*BL/2* )**2-2**BL) ) 

KTAR = 2<**0 MEGAN/! OMEGAN**2+2 •*BL + 1 • I 
CATAR=DCOS( ATAR) 

SATAR=0SIN( ATARI 

RLTARL ( 1 )=KTAR*AY*SATAR 

RLTARL! 2)=AY*CATAR 

RLTARL (3)=AZ*SATAR 

VLTARLt 1 ) =KT AR*.OMEGAN*AY*CATAR 

VLTARU2 ) = -OMEGAN*AY*$ATAR 

VLTARL! 3)=0MEGAN*AZ*CATAR 

WRITE! 6, 101) RLTARL *VLTARL 

CALL MX V! C SL ♦ RLT ARL * RLTAR, 3 * 3 ) 

RMAG = VMAG( RED 
VY=OOT(UYLE,VELf 3) 

DO 3 1=1 *3 

3 OMGEL! I)=VY*UZLE( I J/RMAG 
CALL VXV (OMGEL, RLTAR*TEMP ) 

CALL MXV( CEL, VLTARLt TEMP 1*3* 3) 

DO A 1=1,3 

REVTAR! I ) =REL t 1 )+RLTAR( I ) 

VEVTAR! I )=VEL !I ) +TEMP1 ( I ) +TEMP ( 1 ) 

5 CONTINUE 

WRITE ! 6, 102 I REVTAR, VEVTAR 
WRITE! 6*103) 

FORMAT 1 1H0 * T8 * * COMPUTED TARGET') 

FORMAT! 1H ,T8, 'RLTARL* ,T68,»VLT ARL' /1H *1P6D20.1U 

FORMAT! 1H , T8 *' REVTAR ** T68, * VEVTAR '/ 1H ,1P6D20»11) 

FORMAT! 1 H 0 ) 

RETURN 


100 

101 

102 

103 
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SUBROUTINE LAMB! TO,TF , RSV, VSV, RSE , VSEfRSM, VSMtKNR t I TLMAX ♦ 

16RRMIN T RSVTAR f RSVX,VSVX,RSEX f VSEX,RSMX,VSMX,SllfSl2fS21,S22 

SOLVE LAMBERT PROBLEM BY NEWTON-R APHSON METHOD ITERATING ON 
INITIAL VELOCITY 


1S1 1(3 
2 V S E X ! 3 ) r _ 

3RE MX ( 

ADEL V( 3 I *UDELV ( 3 > t KDELV { 3 ) »PVO ( 6 ) 

COMMON /CONST /MS ? ME , MM , GL 1 * AUM, UT I ME , UVE LM , ERRMAX , DTR 

I TER= 1 

TESTRP= 100*0 
WR1TE(6,108) 

WRITE! 6, 100 ITOtTFt RSVtVSV 
DO 1 1 = 1,3 
PVOl I )=0. 

PVO( 1+3) *0. 

V I T ( I ) = VS V< I ) 


C ALL^ FOUR BY l TO, Tf', RSV , V1T ,RS£, VSE tRSM, V SM, PVOfRSVX, 

1 REMX , VEMX V . . 

DO 3 1=1,3 

ERR! I ) =RSVTAR( I )“RSVX( I ) 

TESTR=VMAG( ERR) 

00 4 1=1,3 
DO 4 J= 1 , 3 
G ( 1 , J) =~S12! I , J) 

WR1TE16,102)RSVX,V$VX 
WRITE16, 107)ERR,TESTR 
IF ( ERR! 3) .NE. 0.0) GO TO 5 
DO 6 1=1,3 
DO 6 J* It. 3 

> G2( I t J )=G( I, J ) t . 

02 = G 2 < 1, l)*G2<2f2)-G2t 1, 2>*G2(2f 1) 

G21! 1, 1)=G2!2,2)/D2 
G2 I! 1 f 2 ) = -G2 ( 1 , 2 ) /D2 
G2 1 ( 2 1 1 ) ””G2 ( 2 f 1 ) /D2 
G21(2,2)*G2! If 1)/D2 
DO 7 Ial.fi 
DO 7 J*lf 2 
GI( I, J)=G2I( I, J) 

GI ! If 3)=0.0 

7 G I ! 3 , J ) = 0 *0 
G I ! 3 , 3 ) =0 • 0 
GO TO 8 

CALL INVERT t G,G1 ) 

IF (TESTR.GE.TESTRP) GO TO 9 

DO 10 1=1,3 
VSV! I ) =V IT { I ) 

IF (TESTR.LT.ERRMIN) GO TO 14 
CALL MXV ! Gl ,ERR,DELV , 3, 3 ) 

DO 11 1=1,3 
DEL V ( I )=-DELV (I ) 

TESTRP=TESTR 


RMVX,VMVX. 


5 

8 

10 


11 



OV=VMAG(OELV) 

CALL UN I TV! OELV tUOELV ) 
KNR = 2 • 0*KNR 
IF(KNR.GT.DV) KNR*DV 
GO TO 12 
9 KNR=KNR/ 10*0 

12 DO 13 1=1,3 

KD6LV ! I >=KNR*UDELV< 1) 

13 V I T I 1)=VSV( I )+KDELV( 1) 
I TER= 1 TER+ 1 
KLV=VMAG<KDELV) 


14 


100 


101 

102 

105 

106 

107 

108 
109 

no 

111 

112 


KLVMIN=10.D-24 
1F1KLV.LT. KLVM1N) GO TO 14 
IFUTER.LT. ITLMAX) GO TO 2 
WRITE (6,112) ' 

STOP 

CONTINUE 
WR I T E ! 6 , 1 09 ) 

WRITE ( 6, 110) VSV 
WRITE!6,111>RSVX,VSVX 
WRITE (6, 103)REVX,VEVX 
WRITE ( 6* 104)RMVX,VMVX 
WRITE(6,105)RSEX,VSEX 
WRITE! 6,106 )RSMX,VSMX 
FORMAT! 1H0,T8, •TO 1 ,T28, 'TF* /1H 
1 ' V S V • / 1 H t lP6D20.11) 
F0RMAT11H0,T8, * ITER' 

FORMAT! 1H ,T8,»RSVX» 

, T 8 , * RE V X * 

, T 8 , ' RMV X * 

, T 8 , 1 RSEX 1 
, T 8 , 1 RSMX • 


, 1P2020.1 1/1H ,T8, 'RSV' ,T68, 


FORMAT ! 1H 
FORMAT! 1H 
FORMAT! 1H 
FORMAT! 1H 
FORMAT ! 1M 


,T28, 
, T68 , 
»Tfe 8, 
t T68 , 
,T68, 
, T68 , 


• / 1H 
*/lH 
•/LH 
'/1H 

« ERR* r T6 8 , ' TE STR • /1H 


»VIT* 
•VSVX 
* VEVX 
♦VMVX 
' VSEX 
' VSMX 


,T8, 

FORMAT! 1H1) _ ^ 

F0RMAT(1H0,T8, 'LAMBERT PROBLEM 
FORMAT ! 1H0 , T 8 , 1 CONVERGED VSV ' / 
FORMAT! lHOtT 8,.' RSV X* ,T68, 'VSVX 
FORMAT! lHOtTB, 'NO. OF LAMBERT 
RETURN 
END 


/1H , I 10tl0XtlP3020.11) 
»/lH , 1P6D20.11) 

, 1P6D20.11) 
tlP6020.il) 

, 1P6D20 • 1 1 ) 

, 1P6D20.11) 

1 1 P4D20 .11) 


HAS CONVERGED') 

1H tlP3D20.il) 

•/1H , 1P6D20.11) 

ITERATIONS HAS REACHED MAXIMUM') 



197 



c 

c 


SUBROUTINE L AMB3 ( TO, TF , RE V , VEV , R EM , VEM, KNR , I TLMAX , ERRM1 N,RE VT AR , 

1REVF, VEVF,REMF ,VEMF , Sll ,S12 t S2 1 ,$22 ) 

IMPLICIT REAL*8( A-H,K~M*0-Z > 

T So[vES 0 3-BODY LAMBERT PROBLEM BY NEWTON-RAPHSON METHOD ITERATING 
[H MENsloN^ RE v'l 3^1 !vEV( 3),REMI3),VEM(3) ??^T*c22 ( 3^3^ ^V^T ( 3?1> ^ ^ * 

1REMF(3),VEMF(3),S11(3,3),S12(3,3),S21(3,3),S22(3,3),VIT(3N 

2PV0(6),RMVF<3),VMVF<3),ERRO>fG(3,3),G2(2,2),G2H2,2) 

3 DEL VI 3) ,UDELV( 3 ) ,KDELV( 3) ^ ^ nTR 

COMMON/CONST3/ME, MM, GAMMA, UDM, UTIME, UVELM t ERRMAX, DTR . 


1 TER= 1 

TE STRP = 100.0 

WRITE(6,100)T0,TF,REV,VEV 

DO 1 1=1,3 

pvom=o* 

PV0(I+3)=0. 


1 VIT l I)=VEV( I) 

2 WRITE(6,101)1TER*VIT 
CALL THRBDY(TO,TF,REV,VEV 


,REM , VEM , PVO ,REVF ,VEVF ,REMF ,VEMF , 51 1 , 


1S12, S2 1 , S22 ) 

DO 21 1=1,3 

RMVF ( ! ) =~*REMF ( 1 ) +REVF ( 1 ) 

21 VMVF ( 1 ) = -VEMF ( I ) +VEVF ( I ) 

DO 3 1=1.3 • , ' 

3 ERR ( I ) =R E VT AR ( 1 ) -RE VF ( I ) 

TESTR=VMAG( ERR) 

DO 4 1=1,3 
DO A J= 1 , 3 
A G ( I , J ) =-Sl 2 ( I, J) 

WRITE(6,102)REVF,VEVF 
WRIT E(6,105)ERR, TEST R 
IF ( ERRt 3) *NE«,0*0 ) GO TO 5 
DO 6 1=1,2 
DO 6 J= 1 ♦ 2 

D 2 = G 2 ( 1,1 )*G2(2,2)-G2U'»2)*G2(2*1 ) 
G2 1(1,1) “G2 (2,2) /D2 

G2I(lt2)=-G2M,2)/D2 

G2 It 2 , 1 ) =~G2 (2,1) /D2 
G2 I ( 2 ,2 )-G2 ( 1 , 1 ) /D2 
DO 7 1=1,2 
DO 7 J = 1,2 


GI ( I , A ) = G2 I ( 1 1 J ) 

GI ( I , 3 ) • 0 • 

7 GI t 3, J ) = 0* 

GI ( 3 , 3 ) =0, 

GO TO 8 

5 CALL INVERT { G»G1 ) 

B IF(.TESTR.GE.TESTRP) 


GO TO 9 



DO 10 1=1,3 

10 VEV ( I) =V IT ( I ) 
lF(TESTR.LT.ERRMIN) GO TO 1A 
CALL MXVtGI ,ERR,DELV,3,3) 

DO 11 1=1*3 

11 DELV( I ) = -DELV ( I ) 

testrp=testr 
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DV=VMAG(OElV) 

CALL UN1TVIDELV ,UDELV 1 
KNR = 2 • 0* KNR 
I F C KNR. GT« DV ) KNR*DV 
GO TO 12 
9 KNR=KNR/10.0 

12 00 13 1=1,3 

KDEL V ( I )=KNR*UDELV ( I ) 

13 V1T( I )=VEV( 1 )+KOELV( I) 
1 TER= I TER+ 1 

KLV*VMAG(KDELV) 


KLVMIN=10.D-24 
IF(KLV.LT.JLVMIN) GO TO 14 
IHITER.LT. ITLMAX) GO TO 2 
WR1TE16,110) 

STOP 

14 CONTINUE 

WR 1 TE < 6 , 1 07 ) 
WRITE(6,108)VEV 
WRITE(6,109)REVF,V6VF 
WRITE I 6, 1031RMVF ,VMVF 


WRITE ( 

100 FORMAT 
1 * VE V * / 

101 FORMAT 

102 FORMAT 

103 FORMAT 

104 FORMAT 

105 FORMAT 

107 FORMAT 

108 FORMAT 

109 FORMAT 

110 FORMAT 


, 1P2D20.11/1H ,T8 , 1 REV 1 ,T68 , 


6,104) REMP » VEMF 
( 1H0,T8, •TO* , T28* • TF’/IH 

(1Ho!t8?UTER« » T28* 1 V IT • /1H ’ * 1°*’ *^ D2 ° * 1 1 ’ 

{ 1H ,T8, • REVF • , T68, • VEVF # / 1H , 1P6D20.11) 

(1H ,T8, * RMVF * ,T68, 1 VMVF • /1H 
(1H ,T8, *REMF» ,T68,’VEMF« / 1H 
I1H .tT8 f *ERR # ,T68, , TESTR*/1H 
( 1H0,T8,* LAMBERT PROBLEM HAS 
<1H0,T8, ’CONVERGED VEV’/iH ,1P3D20.11> 
i i un t r * RFVF * • T68 , * VEVF * / 1H , 1P6D20. 11) 

(lHO, f T8, T »NO. OF LAMBERT ITERATIONS HAS REACHED MAXIMUM’) 


, 1P6D20.11) 
, 1P6D20.11) 
, 1P4D20.11) 
CONVERGED’ ) 


RETURN 

END 




DO- 1 1=1,3 

R SB { I ) =RSE I I )+MEM*REMC I ) 
VSB( I) = VSE( I )+MEM*VEM< I ) 


RSDll)*=RSE<I> 

V$D( n = VSE( I > 

RSL1C r) = (U~GLl>*RS6( I ) 

1 VSL1 ( I )*(1*-.GL1 )*V$B< I) 
CALL UNITVC RSE,UXDS) 

CALL VXVCRSE, VSE,Q) 

CALL UNIT V ( Q ,UZD$ 1 
CALL VXVCUZDS,UXDS,UYOS) 

DO 3 J=l*3 
cost 1 , J ) =UXDS( J ) 

CDSC2, J)=UYO$( J) 

3 COS ( 3 , J ) =UZDS ( J ) 

RSEMAG=VMAG(RS6) 
VY=DOTCUYDS, VSE,3) 

DO 4 1=1,3 

4 OMGSDM )=UZDS( I l*VY/RSEMAG 


DO 5 1=1,3 

RDVI 1 ) = RSV f 1 )-RSD( 1) 

VDV( n=VSV( I )-VSD( I) 

RDSC I ) = -RSD C I ) 
vDsm=-vsou> 
rohc d-rshc n-RSO(.n 

VDMC 1 ) =V SM ( I>-VS0( 1) 
rdli m=RSLin >-rso(i) 

5 VDL1 ( 1 )®VSL1( I )r-VSD( 1 ) 

COMPUTE STATE VECTOR IN ROTATING FRAME 
CALL MXV(CDS,RDV,RDVD,3,3) 

CALL VXVCOMGSD, RDV, TEMPI ) 

DO 6 1=1,3 

6 TEMP2 ( I ) = VOV ( .1 JrTEMPl ( I ) 

CALL MXV(CDS,TEMP2,VDVD,3,3) 

CALL MX VC CDS,ROS,ROSO,3,3 ) 

CALL VXVCOMGSD,ROS, TEMPI) 

DO 7 1=1,3 

7 TEMP2C 1 >=VDS( 1 > -TEMPI ( I ) 

CALL MXV(CDS»TEMP2, VOSD, 3,3) 

CALL M XV l CDS » RDM , ROMD ,3,3) 

CALL VX V ( OMGSD, RDM * T EMP 1 ) 

DO 9 1=1,3 



9 TEMP2 ( I ) = VDM ( I > —TEMPI ( I ) 

CALL MXVCCOS , TEMP2 , VDMD , 3 , 3) 

CALL MX V ( CDS » RDL 1 * RDL ID, 3,3) 

CALL VXV ( OMGSD t RDL 1 , TEMP 1 ) 

DO 10 1=1,3 

10 TEMP2 ( I ) =VDL 1 ( I) -TEMPI ( I) 

CALL MX V( CDS , TEMP2 , VDL ID, 3 , 3 ) 

C COMPUTE ANGLES AT SUN , EARTH AND VEHICLE 

CALL UN I T V ( RSE,URSE) 

CALL UN1TV( REV fUREV ) 

CALL UN 1TV(RSV,URSV) 

ANGV = DARC0S(D0T<UREV,URSV,3M/DTR 

ANGE = DARCOS 1 -DOT ( URSE ,UREV ,3 ) ) / OTR 
ANGS= 1 80 .0-1 ANGV+ANGE ) 

RETURN 

END 
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E EM=ME/ l ME+MM ) 

DO 1 1=1,3 
R EDI I ) =R EM( 1) 

VE D ( I ) = VEM( 1 ) 

REL< 1 )={ 1 .-GAMMA ) *REM( I) 
1 VEL ( 1 ) = (1 .-GAMMA ) *VEM I I ) 
CALL UNI TV ( REM,UXDE) 


CALL VXV( REM, VEM,Q ) 

CALL UNT TV ( 0 ,UZDE ) 

CALL VXV(UZDE,UXDE,UYDE1 

DO 2 J=1 ,3 

COE { 1 , J )=UXDE ( J ) 

CDE ( 2 , J > =UYDE f J ) 

2 CDE(3,J)=UZDE< J) 

REMMAG=VMAG(REM) 

VY=DOT ( UYDE , VEM , 3 ) ' 

DO 3 1=1,3 

3 OMGEO< I )=UZDE< I )*VY/REMMAG 
DO 4 1=1,3 

RDV( I ) =RE V( 1 ) -RED < I ) 

VDV ( I)=VEV( I ) -VED ( I ) 

RDE ( l )=-RED< I ) 

. VDE ( I ) =-VED ( I ) 

RDL( I )=REL( 1 )-RED( IT 
A VDL( I)=VEL( I)-VED(I) 

COMPUTE STATES IN ROTATING FRAME 
CALL MXV(CDE,RDV, RDVD, 3,3) 

CALL VXV( OMGED,RDV, TEMPI ) 

DO 5 1=1,3 

b TEMP2 ( I ) = VDV ( I ) -TEMPI ( I ) 

CALL MXV(C0E,TEMP2,VDVD,3,3) 

CALL MXV(CDE,RDE,RDED,3,3) 

CALL VXVIOMGED, RDE, TEMPI) 

DO 6 1=1,3 

6 TEMP2 ( I) =VDE ( 1) -TEMP 1( I) 

CALL MXV( CDE, TEMP2 , VDED, 3,3) 

CALL MXV (CDE ,ROL , RDLD, 3 ,3 ) 

CALL VXV(OMGED,ROL, TEMPI) 

DO 8 1=1,3 

8 TEMP2 M ) =VDL ( I ) -TEMP 1(1) 

CALL MXV I CDE , TEMP2 , VDLD , 3 , 3 ) 

COMPUTE ANGLES AT VEHICLE, EARTH AND MOON 
CALL UNI TV ( REM ,UREM ) 

CALL UN IT V ( RMV, URMV ) 

CALL UN I TV ( REV ,UREV ) 

ANGV = DARCOS I DOT ( URMV , UREV, 3 ) ) /DTR 
ANGM=DARCOS( -DOT( UR EM, URMV , 3 ) ) /DTR 



ANGE=180- 0-( ANGV+ANGM ) 

RETURN 

END 



SUBROUTINE PTRAJ 
IMPLICIT REAL* 8! A-H* L-M,0-2 ) 

DIMENSION R S V ( 3 ) » V SV ( 3 ) ? RE V ( 3 ) , VEV ( 3 ) , RMV ( 3 ) ,VMV(3) ,RSE<3> , 
1VSE( 3) ,RSM( 3.) ,VSM! 3 ) ,RDVD( 3) ,VDVD< 3) ,RDSD( 3) tVDSDl 3) , 

2RDMD! 3 ) , VDMO ( 3 ) » PV ! 6 ) , RSL 1 ( 3 ) t VSL 1 ( 3) »ROLIO( 3 ) » VDL ID! 3 ) 
DIMENSION REM ( 3 ) ♦ VEM! 3 ) ' 4 

COMMON/ T DAT A /TO, T, H,RSV* VSV, RE V , VEV , RMV , VMV , R SE , V SE ,RSM, VSM 
1 REM ? VEM, RSL 1 *VSLi »RDVD»VDVD»RDSDf VDSDfRDMDrVDMDr 
?RDL1D,VDHD» PV*LM, LDMf ANGV, ANGEt ANGS 
COMMON/CONST/MS, MEf MM,GL1 ,AUM» UTIME ,UVELM,ERRMAX ,DTR 
COMMON/FLAG/ IMTX, IPV, IPTRAJ, IPVTM, 1FILE, ITER, ITAR 

TDA Y= ( T-TO ) *UT IME 
HDAY=H*UT IME 
RSVMAG=VMAG(RSV) 

REVMAG=VMAG(REV) 

RMVMAG=VMAG( RMV) 

WR I TE ( 6, 101 ) 

WRITE! 6, 100 IT , TO AY , H ?R SVMAG , RE VMAG ,RMVMAG 

PRINT STATES IN INERTIAL S-FRAME 

WRITE(6,100)RSV,VSV 

WRITE! 6,100)REVfVEV 

WRITE! 6 , 100 ) RMV , VMV 

WR I TE ! 6 » 1 01 ) 

WRITE!. 6,100)RSE,VSE 
WRITE!6,100)RSM,VSM 
WRI TE! 6, 100) REM, V EM 
WR I TE ( 6, 100 I RSL 1 * VSL 1 
1 VIR I TE ! 6, 101 ) 

PRINT STATES IN ROTATING D-FRAME 

WRITE(6,100) RDVDtVDVO 

WR1TE!6,100)RDSD,VDSD 

WRIT€!6,100) RDMD , VOMD 

WRITE! 6, 100 )ROL 10,V0L ID 

WRITE ! 6, 101 ) 

WRITE! 6, 102)ANGV,ANGE,ANGS,HDAY 
IF! IPV.EQ.O) GO TO 1 
PRINT PRIMER VECTOR 
WRITE! 6, 100) PV 
WR I TE C 6, 103JLM, LDM 
1 CONTINUE 

WRITE! 6, 104) 

100 FORMAT < 1H ,1P6D20.11) 

101 FORMAT! 1H ) 

102 FORMAT ! 1 H , 1 P4D20 * 1 1 ) 

103 FORMAT ( 1H , 1P2D20.11) 

104 FORMAT! 1 HO , * * 1 } 

RETURN 

ENO 


SUBROUTINE PTRAJ3 



HDAY.= H*UTIME 
REVMAG=VMAG(REV) 
RMVMAG=VMAG< RMV) 


WR 1 TE ( 6* 1 01 ) • v 

WRITE! 6* 100 ) T t tDAYf H tHDAY * RE VM AG * RMVMAG 
PRINT STATES IN INERTIAL E-FRAME 
WR I TE ( 6* 100.) RE V » VEV 
WRITEI6, 100)RMV,VMV 
WRITE(6 t 100)REM,VEM 
WR I TE ( 6 1 100 )REL tVEL 
WRITE (6*101) 

PRINT STATES IN ROTATING D-FRAME 

WRITE! 6,100 )RDVO,VD VO 

WRITE<6, 100)RDEDtVDED 

WRITE (6, 100 VROLDfVOLO 

WR I TE < 6 » 102 ) ANG V » ANGE ♦ ANGM 

IF! IPV.EO.O) GO TO 1 

WRITE! 6*101 ) 

WR 1 TE ( 6* 100 ) PV 

WRITE!6*103)LM,lDM 
FORMAT ( 1 H , 1P6D20.11) 

FORMAT! IH ) 

FORMATllH * 1P3D20 • 11 ) 

FORMAT! 1H , 1P2D20.11) 

CONTINUE 

RETURN 

END 
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SUBROUTINE FDATA 

IMPLICIT REAL*8I A-H,K-M,0-Z ) 

DIMENSION RSV(3) ,VSV(3) , REV ( 3 ) , VE V ( 3 ) »RMV(3) ,VMV{ 3 ) ,RSE(3> , 
1VSEI3) ,RSM< 3) ,V$M( 3) ,RSL1 (3) , VSLl( 3 ) ,ROVD( 3 ) , VDVD(3 ) ,RDSO(3 ) » 
2 VDSD ( 3) f RDMD13) ,VDMD(3> ,RDL1D(3) , VDL ID ( 3 > , PV ( 6 ) , 


NUMBERS 
FILLED WITH 


3DUM(S),REM(3»,VEM<3) , ^ 

COMMON/TDATA/TO,T ,H,RSV,VSV,REV,VEV,RMV,VMV,RSE ,VSE ,RSM,VSM, 

1REM»VEM,RSL JtVSLl * RDVD, VDVD, RDSD , VDSD * RDMD , VDMD, 

2RDI 1D,VDL1D,PV,LM,LDM,ANGV,ANGE,ANG$ 

EACH RECORD CONSISTS OF IOO DOUBLE PRECISION UNFORMATED 
FILED SEQUENTIALLY. THE LAST 15 NUMBERS ARE BLANKS 
ZEROS AND MAY BE USED FOR FUTURE EXPANSION. 

DO 1 1=1,15 
L OUM ( I ) =0. 

RSVMAG=VMAG(RSV) 

VSVMAG=VMAG( VSV) 

REVMAG=VMAG(REV) 

VEVMAG=VMAG( VEV) 

RMVMAG=VMAG t RMV ) 

VMVMAG= VMAG ( VMV ) 

WRITE ( 8 ) T , H, RSV , VSV , REV»VEV » RMV,VMV,RSE»VSE ,RSM,VSM,REM,VEM, 
1RSL 1 » V$L 1 » RDVD, VDVD, ROSD , VDSD, RDMO, VDMD,RDL ID, VDL ID * 
2PV,LM r L0M, ANGV, ANGE , ANGS , RSVMAG , V SVMAG ,REVM AG ,VEVMAG ,RMVMAG , 


3VMVMAG, DUM 
RETURN 
END 




SUBROUT JNE FOATAB 

1VEL(3)!rDVO(3),VDVD(3),ROED(3),VDED(3),ROLD(3),VDLD(3),PV(6), 

Z C0MM0N^DATA3/T0,T,H,REV,VEV,RMV,VMV,REM,VEM,REUVEL,R0VD, 

lVDVD,RDED,VDED,RDLD f VOLO,PV»LM f LDM f ANGV, ANGEf ANGM 

DU 1 1=1 »1^ 

. DUM( I } = 0. 

REVMAG=VMAG(REV> 

VEVMAG=VMAG( VEV) 

RMVMAG=VMAG(RMV) 

REMMAG=VMAG( REM ) 

WRm(8KtHlREvlvEV,RMV,VMV,REM,VEM,REL,VEL,RDVO,VDVD,ROED, 

1 VDED,RDLDf VDLD? PV t.LM» l_DM» ANGVt ANGE * ANGMt OUM 
RETURN 
END 






SUBROUTINE COMAUGIF ,G,TSI »LTtV,LtFG,GG} 

IMPLICIT REAL*8(A-H,L-N,0-Z) . , •. 

DIMENSION TS I ( 3) ,G < 3 > , LTL I ( 3 ,3 ) , LT ( 3 , 3 ) , L ( 3 t 3 > ,NU < 3 > 
1 T E MP 1 ( 3 , 3 ) , T EMP 2 ( 3 , 3 ) , DUM ( 3 I > V ( 3 * 3 ) 

CALL MTRANS(LT,L,3,3) 

CALL MXM{ LT, V, TEMPI ,3,3,3 ) 

CALL MXMITEMP1 ,L ,TEMP2, 3,3,3 ) 

CALL 1NVERT(TEMP2,LT11 ) 

CALL MXM(LTL I ,LT , TEMPI ,3,3, 3 ) 

CALL MXM( TEMPI , VtTEMP? , 3,3, 3 ) 

CALL MXVMTEMP2, G ,NU ,3,3) 

DO 1 1 = 1,3 

1 NU( I) = -NU( I) 

FG=F+OOT(NU, TSI ,3) 

CALL MXV ( L , NU , DUM ,3 , 3 ) 

DO 2 1=1,3 

2 GG( I ) =G( D+DUMU) 

WRITE (6, IOO)FG,GG 

WRITEI6, 101) . - V, * 

100 FORMAT t 1H ,T8, • FG' ,T28, * GG ' /1H » 1P4D20. 11 

101 FORMAT ( 1H0, T8, 1 * * } 

RETURN • ' ... 

END 
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,GG ( 3 ) * 



SUBROUTINE COMDX(LTS,tS,T$lS,DX) 

CALL MXM{ LTS,LS,TEHP1,3,3,3 ) 

CALL INVERTITEMP1,TEMP2) 

CALL MXM< LS t TEMP2* TEMPI * 3 1 3 1 3 ) 
CALL MXV ( TEMP 1 , T S I S , OX , 3 , 3 ) 

DO 1 1=1,3 
1 OX{ I )=~DX( I > 


RETURN 

END 



SUBROUTINE UPX ( XD ,FD , TESTRO ,GO , T S 1 0 , LTD , LD ,FGD ,GGD , SI ID , S 1 2D , 

lSZin,S22D,UVIO,UVFD,XtF,TESTR,G,TSI,LT,L,FG,GG,Sll,S12,S21,S2Z, 

2UVI ,-UVF ) 

IMPLICIT REAL*8(A-H,L,N,0-Z) _ 

DIMENSION xn(3},GO(3),TSID(3l,LTD(3,3),LD(3,3),XI3 ,G(3) 

iTS ,, Il3)tLT(3«3),L(3»3)*S110(3*3)»S12D(3..»3)»S210(3t 3 ) » S2 * ’ 

2SH ( 3,3) , SI? (3,3) ,52113,3) , 522(3, 3) ,GG(3I ,UVIO(3) ,UVFD(3) , 

Mi VI i 3) ,UVF(3) *C,GD< 3) 

F = FD 

TESTR=TESTRD 
■FG*FGD . ,• ■ 

00 1 1=1,3 
X< 1 } = XD( H 
G ( 1 )=GD( I ) 

TSH I ) =T S ID ( I ) 

GG( I ) = GGD ( 1 ) 

uvn n=uvio( i) 

UVF ( I ) =UVFD ( n 
DO 1 J==l *3 


L T { ] , J)=LTD( I » J- ) 
L(I»J>=LD( ItJ) 

sini»j)=snD(i.J) 

S 1 2 ( 1 * J ) = S 1 2 P ( I » J ) 


S2K 1 1 J ) » S2 l'O ( It J) 
$22 ( It J ) =S22D( I, J) 
1 CONTINUE 


RETURN 

END 
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SUBROUTING PVECIT ,'R, V , PVO, STM, PV, LM, LDM ) 


IMPLICIT REAL*8(A-H,L,U~Z> 

DIMENSION R ( 3 ) , V ( 3 ) , PVO< 6 ),PV(6)»STM{6,6>,DL(3),DID(3), 
1-RTMC3 ) ,VTM( 3 ) , PVTM( 3 ) , PVDTM( 3 ) » STNTM ( 6 , 6 ) 

COMMON/FLAG/ IMTX t I P V , I PTRA J , I PVTM, IFILE, ITER, ITAR 

COMMON /C TM/TTM , RTM , VTM , t_TM , IDTMt PVTM , PVDTM , STNTM 

CALL MX V (STM, PVO , PV, 6,61 
on 3 1=1,3 
DL ( I ) = PV< I) 

* OLD ( I )=PV( 1+3 ) 

LM= VMAG ( DL ) 

LDM=D0T(DL,DL0,3)/LM 
IF< IPVTM.LE.O) GO TO 2 
I F(LM.LE.LTM) GO TO 2 

ltm=lm 

LDTM=LDM 
TTM = T 


DO 1 1=1,3 
RTM( 1 ) = R ( I ) 

VTM < I ) =V 
PVTM ( I ) =DL ( I ) 

PVDTM ( I ) =DLD ( 1 ) 

DO 1 J= 1 , 3 
STNTMU, J)=STM( I , J ) 
STNTMI I , J+3 ) = STM( I * J+3 I 
STNTM ( 1 + 3 , J ) = STM ( 1 + 3 * J ) 


1 STNTM( 1+3, J+3T-STM< 1 + 3, J+3 ) 

2 CONTINUE 
RETURN 
END 
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V 

4 . ' ' . 

SUBROUTINE RVEMVI RSV , V SV ? R^SE 9 V SE » R SM , VSM »REV , VE V ?.RMV *VMV-» 

1 REM, VEM ) 

IMPLICIT REAt*8(/A-H,0-Z) . 

DIMENSION RSV (3 I , V SV ( 3 ) » RSE ( 3 ) ? V SE ( 3 ) ,RSM( 3 ) , VSM ( 3 ) » R E V ( 3 ) » 
1VEV13) , RMV ( 3 ) ,VMV ( 31 ,REM( 3 ) ? VEM( 3 ) 

no ii = i ,3 •; 

RE V ( I ) =^RSE ( I ) +RSV( I ) 

VF V ( I I--VSEI 1)+VSV( I) 

RMV i I )=-RSM( 1 ) + RSV ( I ) 

VMV l I ) = “V SM ( I ) + VSV( 1 ) 

RFMl I)=-RSE( D+RSMI 1 ) 

1 VE M ( 1 )=-VSE( I )+VSM( I ) 

RETURN 

END 
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SUBROUTINE MXV ( A ♦ V , VN , M , N ) 

IMPLICIT R-EAL*8t A-H,0~Z ) 

MATRIX VECTOR MULTIPLICATION A(M,N) V(N)=VN(M) 
DIMENSION A ( M , N ) ♦ V ( N ) * VN ( M ) 

DO A 1=1, M 
S = 0. 

DO 3 J=1,N 

3 S=S + A( I , J )*V ( J ) 

4 VN< I ) = S 
RETURN 
END 



SUBROUTINE WT ( V/VVt IDIM) 

IMPLICIT R6A'L*8TA-HfO-Z ) 

OUTER PRODUCT OF ? VECTORS OF DIMENSION I DIM 
DIMENSION V( 1DIMI ,VV( IDIM t IDIM) 

DO 1 I=1,1D1M 
DO 1 J=1 f IDIM 
1 VV( I t J)=V( I )*V< J) 

RETURN 

END 



DOUBLE PRECISION FUNCTION DOT ( V1'*'V2* I.D1M ) 

IMPLICIT REAL*8( A-H,0~Z > 

DOT PRODUCT OF 2 VECTORS 
DIMENSION VI t ID 1 MV * V 2 ( ID1M) 

s=o, 

DO I 1=1 , ID1M 
S=$ + V1 ( I )*V?M ) 

Of 1 T = S 

RETURN 

END 



double precision FUNCTION VMAG(V) 

IMPLICIT R'EAL*8(4-H* 0 - 2 ) 

MAGNITUDE OF VECTORS OF DIMENSION I DIM 
DIMENSION V(3) 

s=o • 

DO 1 1=1,3 
S = S+V{ 1)**2 
VMAG=DSORT(S) 

RETURN 

END 



SUBROUTINE 1NVERT(B,BI> 

IMPLICIT REAL*B( A-HtO-Z ) 

INVERSION OF A 3X3 MATRIX 

DIMENSION B ( 3 1 3 I »BI(3»3) „ 

D=B( l,n*( B(2*2>*B<3»3 )-B<2t3)*B< 3t 2 )) + B( 2,1)* C B( 1,3 
1 B 1 1 * 2 ) * B ( 3 » 3 ) ) + B ( 3 1 1 ) * ( B ( 1 ♦ 2 ) * B ( 2 » 3 ) -B 1 1 * 3 ) * B ( 2 1 2 > ) 

B I ( 1 ♦ 1 ) = ( B ( 2 1 2 ) * B ( 3 » 3 ) — B ( 2’ ♦ 3 ) ( 3 ?.2 ) )/D 

BI(2tl )= (B( 2 ? 3 )*B( 3» 1 )-B( 2t 1 >*B(3f3> )/D 

BI<3*l) = (B(2»l) ,} ‘B(3f2)~B(2»2)*B{3»lJ)/D 

BI l 1 T 2 ) = (Bllt3)*B( 3t2)-B( 1 ♦ 2 ) *B ( 3 1 3 ) >/D 
BI (2,2)«( B( It 1)*B(3'*3)-^B( 1 »3)*B< 3»1 ))/D 
B I ( 3 » 2 ) = ( B ( 1 1 2 ) ^ B ( 3 1 1 ) **B( 1 * 1 ) ( 3 1 2 ) )/D 
BIT X,3) = ( Bt 1 ,2)*B( 2,3)-BI 1 » 3 )*B ( 2* 2 )) /D 
B I < 2 1 3 ) = ( B ( 1 f 3 ) * B< 2 1 1 ) ~B ( 1 ♦ 1 ) * B l 2 1 3 ) ) /D 
BI (3 t 3) = C B( ltl)*B<2f 2 ) — B( 1 f 2 )*B ( 2 * 1 ) )/D 
RETURN 
END 



SUBROUT IN6 UN 1 T V( A »UA ) 
IMPL ICIT REAL*8( A~H,0-Z ) 
DIMENSION A ( 3 ) ?. U A ( 3 ) 

s=o . 

DO ) 1=1,3 

1 S=S+A(1)**2 
AMAG=DSGRT< S ) 

DO 2 1=1,3 

2 UA( I ) = A ( I I/AMAG 
RETURN 

END 



SUBROUTINE VX V ( V I , V2 * V3 ) 

IMPLICIT REAL*8< A-H,0-Z ) 

CROSS PRODUCT OF 2 3-DIMENSIONAL VECTORS 
DIMENSION VIO) r V 2 C 3 ) ,V3(3) 

V3( l)=Vl{2)*V2(3)-Vl(3) ,5c V2(2) 

V3(2 >=V1(3)*V2( 1)-V1(1)*V2(3) 

V3( 3 ) - V 1 < 1 ) *V2 ( 2 ) -V 1 t 2 >*V2( 1 ) 

RETURN 

END 



SUB.ROUT 1NE MTRANSI A, B, IROW, 1C0L ) 
IMPLICIT REAL*8( A-H,0-Z ) 

TRANSPOSE A MATRIX OF IROW X I COL 
DIMENSION A ( IROW , I COL) ,B< 1 COL, I ROW I 
DO 1 1=1, IROW 
DO I J=1 f ICOL 
1 B( J , 1 ) = A ( I,J) 

RETURN 

END 



SUBROUTINE MXM < A , B t C * K t L , M ) 

IMPLICIT REAL* 8 ( A-HfO-I) M 

MATRIX MULTIPLICATION A(K,L) B < L »M ) =C ( K , M ) 
DIMENSION A(K>L) ?'B(L»M). 

DO A I = 1 ? K 
DO A J = 1 » M 
S = 0. 

on 3 N=1,L 

3 S=S+A( 1 ,N)*'B(N« J) 

A C ( 1 1 J ) -S 
RETURN 
END 
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